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I. 


INTRODUCTION 


A.  GENERAL  CONCEPT 

The  need  to  improve  industrial  productivity  has  greatly 
motivated  the  implementation  of  a  variety  of  forms  of 
automation.  With  respect  to  this  fact,  programmable  multi¬ 
functional  manipulators  (robots) ,  have  become  increasingly 
important.  Due  to  the  fact  that  the  robots  will  play  a 
major  role  in  future  manufacturing  systems,  the  need  for 
improvement  of  robot's  performance  becomes  imperative. 

One  of  the  major  drawbacks  of  today's  robots  is  that  in 
general  they  are  very  slow.  The  speed,  with  which  they  can 
transfer  objects  from  one  point  to  another,  is  at  many  cases 
limited  by  the  weight  of  the  manipulator  arm.  The  excessive 
arm  weight  not  only  hampers  the  rapid  motion  of  the  mani¬ 
pulators  arm,  but  also  increases  the  robot's  consumption  of 
energy  and  the  size  of  the  required  actuators. 

A  flexible  manipulator  is  free  of  these  drawbacks, 
because  it  requires  less  material  that  results  in  less  arm 
weight,  less  power  consumption  and  increased  maneuverability 
compared  with  the  traditional  (rigid-arm)  manipulators.  The 
flexible  manipulator  also  uses  smaller  actuators  because  of 
the  smaller  power  demand. 

Therefore  flexible  arm  manipulators  are  particularly 
advantageous  in  small  lot  manufactu  -ing  and  also  very 
attractive  for  space  applications. 
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Manipulator  arms  require  a  reasonable  accuracy  in  the 
response  of  the  arm's  end-point  to  the  joint  control  system 
input  commands.  In  order  to  achieve  this  accuracy  most  of 
the  manipulator's  arms  exhibit  some  vibrations.  These 
vibrations  have  been  eliminated  by  increasing  the  rigidity 
of  the  manipulator's  arm. 

In  the  case  of  the  flexible  manipulators  the  above 
solution  is  unsatisfactory  if  their  basic  advantages  stated 
above  are  not  to  be  sacrificed. 

It  is  clear  that  in  order  to  realize  the  very  attr¬ 
active  features  of  the  flexible  manipulator  arm,  extensive 
research  has  to  be  performed  in  both  the  areas  of  design  and 
control  of  the  system.  Obviously  a  control  system  has  as 
tasks  to  perform  the  required  motion  for  the  flexible  arm  of 
the  manipulator  with  a  reasonable  accuracy  in  the  arm's  end¬ 
point  position,  but  also  to  control  the  vibration  modes  of 
its  links. 

B.  THESIS  OBJECTIVE 

The  manipulator  that  will  be  used  through  this  thesis 
will  be  a  two  links  planar  robot  arm  having  the  first  link 
rigid  and  the  second  link  flexible. 

Controlling  the  proposed  manipulator  to  obtain  position 
accuracy  of  the  end-point,  fast  response  and  control  of  the 
vibration  modes  of  the  flexible  link  is  a  very  complicated 
problem  because  the  dynamic  motion  of  the  manipulator  is 
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strongly  influenced  by  mechanical  design  and  physical 
properties  of  the  manipulator,  as  well  as  environmental 
effects.  Coupling  inertia,  coriolis  forces,  actuator 
dynamics,  joint  friction,  centripetal  forces,  gravity 
effects  and  mainly  the  vibration  modes  introduced  due  to  the 
elastic  motion  of  the  flexible  link  and  the  coupling  of  the 
two  links  create  an  overall  system  that  is  a  very  nonlinear 
dynamic  system.  Because  of  the  nonlinear  dynamic  model  of 
the  manipulator  a  robust  and  flexible  control  system  is 
reguired. 

The  velocity  curve  follow  technique  is  a  powerful 
control  scheme  that  was  successfully  used  to  control  a 
single  flexible  arm  [Ref.  1]  and  also  for  a  near  minimum 
time  positioning  of  a  planar  robot  arm  with  two  rigid  links 
[Ref.  2],  A  feasibility  study  will  be  done  in  the  appli¬ 
cation  of  the  same  technique,  the  velocity  curve  follow 
control  scheme,  for  the  proposed  manipulator  model.  In 
order  to  compare  the  results  of  the  proposed  rigid-flexible 
planar  robot  arm,  for  fast  and  accurate  response,  with  the 
results  of  a  planar  robot  arm  with  two  rigid  links,  the 
model  of  a  rigid-rigid  planar  robot  arm  having  similar 
parametric  data  and  using  the  same  adaptive  control  scheme 
will  be  developed  and  tested. 

The  advantages  of  this  technique  are  the  adaptive 
nature  and  the  simplicity  of  the  control  scheme  loop,  that 
can  also  be  implemented  in  a  digital  computer  or  micro- 
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processor  with  the  output  signals  through  a  D/A  converter 
used  to  drive  the  motors  acting  on  the  manipulators  joints. 
Problems  arising  from  modelling  uncertainties,  unpredictable 
environmental  changes  and  noise  contamination  of  the  signals 
can  be  taken  into  account  and  solved  through  the  adaptation 
procedure . 


C.  BASIC  CONCEPTS  OF  THE  ADAPTIVE  MODEL 

A  very  simplified  block  diagram  of  the  adaptive  control 
scheme  that  will  be  used  is  illustrated  in  Figure  1.1.  In 
order  to  control  the  motion  of  the  manipulator's  links  the 
adaptive  control  scheme  receives  from  the  actuator  the 
position  of  each  link.  Knowing  the  position  and  previous 
values  of  the  position,  the  digital  computer  calculates  the 
velocity  and  updates  the  gain  constant,  the  position  and  the 
velocity  of  the  second  order  model,  used  to  model  the  real 
motor  :.n  the  computer,  at  certain  time  intervals.  Another 
advantage  of  this  control  scheme,  concluded  from  the  basic 
implementation  described  above,  is  the  elimination  of  a 
tachometer  requirement. 

The  block  named  'Curve  follower',  approximates  the 
deceleration  curve  of  an  ideal  motor.  This  curve  can  be 
obtained  as  an  analytic  expression  or  as  a  table  look-up 
stored  in  the  memory  of  the  digital  computer. 

The  'Model-environment'  block  represents  the  dynamic 
equations  that  describe  the  given  system.  In  this  block  are 
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Figure  1.1  Simplified  block  diagram  of  the  system. 

also  included  gravitational  torques,  centripetal  forces, 
Coriolis  forces,  inertia  of  the  loaded  arm,  forces  acting  on 
the  rigid  and  the  flexible  links  due  to  the  elastic  motion 
of  the  flexible  beam. 

The  motors  acting  at  the  two  joints  are  identical, 
using  the  same  adaptive  velocity  curve  follow  control 
scheme.  At  the  adaptive  model  both  actuator  and  ideal  motor 
are  driven  by  the  same  velocity  error  input. 
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D.  ORGANIZATION  OF  THE  THESIS 

In  Chapters  II  and  III  the  mathematical  models  for  the 
rigid-rigid  and  rigid-flexible  two  links  planar  robot  arm 
will  be  developed  respectively. 

Some  preliminary  studies  of  the  models  will  be  per¬ 
formed  in  Chapter  IV,  including  frequency  response  of  the 
systems  which  will  help  to  extract,  some  important  for  the 
adaptive  model,  data  from  the  prominent  physical  chara¬ 
cteristics  of  the  systems. 

The  development  of  the  computer  simulation  model,  that 
will  be  used  in  both  cases,  will  be  derived  in  Chapter  V, 
where  the  velocity  curve  follow  control  scheme  will  be 
developed  and  simulated. 

In  Chapter  VI,  the  velocity  curve  follow  will  be 
applied  as  the  control  scheme  of  the  rigid-flexible  planar 
robot  arm,  described  by  the  model  derived  in  Chapter  III,  in 
order  to  investigate  if  this  control  scheme  is  applicable. 
Simulations  under  different  conditions  (load,  gravity 
environment)  will  be  performed.  Simulation  results  will  be 
obtained  under  the  same  conditions  for  the  rigid-rigid 
planar  robot  arm,  described  by  the  model  derived  in  Chapter 
II,  and  the  results  will  be  compared. 

In  Chapter  VII,  the  conclusions  and  the  requirements 


for  further  studies  will  be  given. 


II. 


MODEL  DEVELOPMENT  FOR  THE  TWO  RIGID  LINKS 


ROBOT  ABM 


h.  INTRODUCTION 

In  this  chapter,  a  mathematical  model  of  a  planar  robot 
arm  with  two  rigid  links  will  be  derived  by  the  use  of 
Lagrangian  mechanics.  The  planar  robot  arm  having  two  rigid 
links  was  partially  investigated  in  Ref. 2.  In  order  to 
compare  the  resulted  equations  of  motion  and  the  performance 
of  the  planar  robot  arm  at  two  different  cases,  one  when 
both  links  are  rigid  and  the  other  when  the  second  link  is 
flexible,  the  study  of  the  two  rigid  links  planar  robot  arm 
will  be  repeated  in  this  thesis. 

Lagrange's  equations  will  relate  the  torques  and  forces 
acting  on  the  system  to  the  position,  velocity  and  accele¬ 
ration  of  each  link  at  any  time.  Therefore,  the  second 
order  differential  equations  that  will  be  derived  following 
this  Lagrangian  dynamics  approach  will  be  the  equations  of 
motion,  that  describe  the  system. 


B.  DEVELOPMENT  OF  THE  MODEL 

The  two  rigid  links  planar  robot  arm  is  illustrated  in 
Figure  2.1.  Both  joints  are  rotary  joints  and  the  motion 
will  be  considered  to  be  on  one  plane,  the  xy  plane.  The 
two  links  having  lengths  1-^  and  12,  are  assumed  to  be 


Figure  2.1  Planar  robot  arm  with  two  rigid  links. 
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massless  and  two  equivalent  masses  mj_  and  m2  are  lumped  at 
the  end  of  LINK1  and  LINK2  respectively.  The  driving 
torques  for  the  motors  at  each  joint  will  be  denoted  as 
and  r2  at  JOINT1  and  J0INT2  respectively. 


C.  DERIVATION  OF  THE  LAGRANGE'S  EQUATIONS 

Defining  the  Lagrangian  function  L,  as  L=T-V,  where  T 

and  V  are  the  kinetic  and  potential  energies  of  the  system, 
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the  equations  of  motion  that  describe  the  system  will  be 
derived  from  the  Lagrange's  equations  defined  as: 


d_ 

dt 


5c«i 


<SL 

5q. 


Qi 


i  =  1, 2 , .  .  .  ,  n 


(2.1) 


where : 

q^  =  the  generalized  coordinates, 

=  the  generalized  forces, 

n  =  the  number  of  degrees  of  freedom. 

For  that  system  configuration  only  two  coordinates  will 
be  used,  because  the  number  of  degrees  of  freedom  must  be 
equal  to  the  number  of  coordinates  which  must  be  used  to 
describe  that  system.  Selecting  the  angles  9-l  and  02  to  be 
the  generalized  coordinates  for  the  system  shown  at  Figure 
2.1,  the  position  of  both  arms  at  any  instant  of  time,  with 
constant  lengths  l-^  and  12 ,  will  be  exactly  specified  from 
these  two  angles.  The  torques  n  and  r2  will  be  the  gene¬ 
ralized  forces  acting  on  that  system.  Derivation  of  the 
kinetic  and  potential  energies  and  construction  of  the 
differential  equations  from  the  Lagrangian  function  L  is  a 
very  lengthy  approach  and  the  detailed  presentation  is  given 
in  Appendix  A.  The  pair  of  the  second  order  nonlinear 
differential  equations  derived  in  Appendix  A,  will  become 
the  equations  of  motion  that  describe  the  system  and  will  be 
used  as  the  mathematical  model  at  the  studies  of  the  two 
rigid  links  planar  robot  arm. 


i  fc.it  » g*  |.t  LI jkf.lt*.!) 


ri  -  <D11+  J1>91  +  °12  9 2  +  D122  9 2 


(2.2) 


+D112  91  9 2  +  °121  92  91  +  D1 


r2  -  <D22+  J2>92  +  D21  »1  +  D211  91  +  D2 


(2.3) 


where 


DH  =  +  B212  +  2m21l12C°S92 


D22  "  Vi 


°12  *  °21  -  "212  +  ,021112C°S92 


°112  °122  °121  D211  ~M21l12SlnQ2 


D,  =  (in1+in2)gl1sinei  +  m2gl2sin  (0n +0., ) 


1"'2I 


°2  "  ™2gi2sin(e1+e2) 


J1  =  the  inertia  of  the  motor  at  J0INT1 


J2  =  the  inertia  of  the  motor  at  J0INT2 


g  =  the  acceleration  of  gravity  (  =  9.814  m/sec  ) 


The  parametric  values,  lengths  of  the  links  and  masses  at 


the  end  of  each  link,  that  will  be  used  in  this  study  of  the 


two  rigid  links  planar  robot  arm  are  given  in  the  Table  2.1. 


The  (i=l,2)  values  defined  in  the  above  equations 


were  obtained  from  the  forces  acting  on  each  link  due  to 


acceleration  and  velocity  of  the  moving  robot  arm.  A  more 


detailed  specification  for  each  value  will  be  given  as 


follows. 


TABLE  2.1 


PARAMETRIC  DATA  OF  A  TWO  RIGID  LINKS  PLANAR 
ROBOT  ARM. 


ft 


I 


IS 


11  =  0.40  m 

12  =  0.32  m 

ml 

2 

=  0.30  kg/m/ sec 

m2 

2 

=  0.05  kg/m/sec 

m2 

2 

=  0.10  kg/m/ sec 

(with  load) 

An  acceleration  of  the  joint  i  causes  a  torque  at  the 
same  joint  equal  to  D-j^ei,  therefore  at  this  particular 
system  D^i  and  D22  represent  the  effective  inertias  for  the 
joints  1  and  2  respectively.  Also  an  acceleration  at  one 
joint  i  will  cause  a  torque  at  joint  j  of  the  form  D^je^j, 
and  for  the  particular  system  D^2  and  D21  are  the  coupling 
inertias.  Also  a  velocity  at  joint  i  will  produce  a  centri¬ 
petal  force  at  joint  j  having  the  form  and  therefore 

d122»  d211  are  the  centripetal  forces  for  that  system 

(notice  Din=D222=0) .  A  combination  of  the  form 
+Dikjekej  are  the  produced  coriolis  force  acting  at  joint  i 
due  to  the  velocities  at  joints  k  and  j,  therefore  for  the 
two  link  model  the  coriolis  forces  will  be  represented  by 
the  coriolis  acceleration  coefficients  D112,  D121,  D212  and 
°221- 


I 
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III.  MODEL  DEVELOPMENT  FOR  A  PLANAR  ROBOT  ARM 
WITH  TWO  LINKS.  THE  SECOND  FLEXIBLE 


A.  INTRODUCTION 

The  basic  mathematical  model  that  will  be  used  in  the 
computer  simulations  for  the  planar  robot  arm  with  two 
links,  the  first  rigid  and  the  second  flexible,  has  to  be 
derived.  In  order  to  examine  its  performance  and  to  compare 
the  simulation  results  with  the  results  obtained  for  the 
planar  robot  arm  having  two  rigid  links,  the  two  models  have 
to  be  compatible.  Therefore  the  mathematical  model  of  a 
rigid-flexible  planar  robot  arm,  will  be  derived  in  this 
chapter. 

B.  PRIOR  WORK  IN  THIS  FIELD 

From  previous  works  and  studies  in  the  field  of  robotic 
manipulators  with  structural  flexibility  many  different 
approaches  can  be  used  on  the  derivation  of  the  different 
models.  Book  [Ref. 3]  applies  the  transfer  matrix  method  to 
describe  in  the  frequency  domain  the  elastic  bending  motion 
of  a  two-link  planar  elastic  arm  and  for  small  angular 
velocities.  In  later  work  Book  [Ref. 4]  considered  the 
linear  dynamics  of  spatial  flexible  arms  represented  as 
lumped  mass  and  spring  components  via  4x4  transformation 
matrices.  Maiza-Neto  [Refs. 5  and  6]  develops  the  nonlinear 


equations  of  motion  in  the  time  domain  for  the  same  problem 


using  Lagrangian  dynamics.  Usoro  [Ref. 7]  uses  the  finite 
element/Lagrange  methods  coupled  with  the  concept  of  a 
generalized  inertia  matrix,  derived  for  lightweight  flexible 
manipulators,  to  achieve  positional  and  vibration  control, 
with  the  mathematical  background  for  this  study  presented  by 
Mahil  [Ref. 8].  Schmitz  [Ref. 9]  applies  Hamilton's  principle 
and  uses  boundary  conditions  to  linearize  the  model  of  a 
very  flexible  one-link  manipulator  in  order  to  describe  its 
performance  with  transfer  functions  for  the  end-point 
position  control.  The  latest  procedure  was  followed  by 
Zouzias  [Ref.l]  in  his  attempt  of  controlling  a  flexible 
manipulator  arm  with  an  adaptive  computer  simulation  model. 


C.  DEVELOPMENT  OF  THE  MODEL 

For  the  sake  of  the  comparison  of  the  two  cases,  as  was 
mentioned  before,  Lagrangian  dynamics  was  decided  to  be  used 
for  the  model  development  of  the  two  links  planar  robot  arm 
having  the  first  link  rigid  and  the  second  link  flexible. 
The  model  of  the  planar  robot  arm,  that  will  be  used  through 
this  thesis,  is  illustrated  in  Figure  3.1.  Both  joints  are 
rotary  joints  and  the  system  will  again  assumed  to  have  only 
planar  motion,  on  the  x,y  plane,  with  relative  motion  of  the 
two  links  due  to  the  torques  applied  from  the  motors  at  each 
joint.  The  torques  applied  at  J0INT1  and  J0INT2  will  again 
be  denoted  as  and  r2.  Both  links,  rigid  and  flexible, 
having  lengths  1^  and  12  respectively  are  assumed  to  be 
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Figure  3.1  Two  links  (rigid-flexible)  planar  robot  arm. 

massless  and  two  equivalent  masses  m2  and  m2  are  lumped  at 
the  end  of  each  link.  The  discrete  masses  at  the  end  of  the 
rigid  and  the  flexible  links  represent  the  servo  motor  of 
the  flexible  beam  and  the  end-point  sensor  and  payload. 

D.  DERIVATION  OF  THE  LAGRANGE'S  EQUATIONS 

The  model  will  be  developed  by  superposing  the  flexible 
motion  of  the  second  link  over  the  two  rigid  links  body 


motion.  This  approach  is  in  favor  of  the  finite  element 
Lagrange  method  because  will  there  result  a  set  of  second 
order  differential  equations  similar  to  those  obtained  for 
the  two  rigid  links  planar  robot  arm,  with  additional  terms 
due  to  the  flexibility  of  the  second  link  and  the  coupling 
effects  between  the  rigid  and  the  flexible  link. 

The  coordinates  for  the  rigid  beam,  first  link,  will  be 
defined  as  in  the  "two  rigid  links  arm  model".  For  the 
second  link,  that  is  now  a  flexible  beam,  the  coordinates 
will  be  defined  as  if  the  beam  was  rigid  superposing  in  this 
result  the  flexible  motion.  In  order  to  describe  this 
flexible  motion  the  general  schematic  of  the  model  will  be 
repeated  in  Figure  3.2  introducing  three  reference  frames. 
These  references  frames  can  be  defined  as  follows: 

[ 0 , x , Y ]  :  an  inertial  reference  frame  with  origin  at  J0INT1. 
[OjXj^YjJ  :  a  reference  frame  with  origin  at  0  and  the 
axis  lying  on  LINK1 . 

[01,X2,Y2]  :  a  reference  frame  with  origin  at  0^  and  with 

the  X2  axis  tangent  to  the  flexible  beam  at  the  point  0^. 

The  two  angles  can  therefore  be  defined  as  follows: 

9 2.  =  the  angle  between  the  axis  X  and  X]_. 

02  =  the  angle  between  the  axis  X ^  and  X2 . 

The  overall  motion  can  be  understood  as  a  motion  of  the 
hypothetical  rigid  system  OC^C^  and  a  flexible  motion  of  the 
second  beam,  LINK2 ,  with  respect  to  this  moving  system.  The 
position  of  any  point  of  LINK2  can  be  described  by  a 


convenient  definition  of  a  set  of  coordinates.  As  indicated 


in  Figure  3.2  any  point  P  along  the  flexible  beam  can  be 
specified  if  a  new  variable  u(x2,t)  will  be  defined  as  being 
the  coordinate  of  the  flexible  motion  with  respect  to  the 
reference  frame  [Oi,X2,Y2].  The  position  (coordinates)  for 
any  point  P  of  the  flexible  beam  will  then  be  given  in 
vector  notation  as: 


Rd  =  [l1cos01+  x2cos(e1+e2)  -  u  sin(e1+e2)]  ax 
+[l1sin01+  x2sin(©1+02)  +  u  cos(01+©2)]  a 


(3.1) 


Therefore  the  Cartesian  coordinates  of  the  end-point  of  the 
flexible  arm  can  be  expressed  from  the  following  equations: 


x2  =  l1cos©1  +  l2cos(©1+02)  -  uEsin(01+©2) 


y9  =  l1sin01  +  l0sin(©1+©2)  +  uvcos (©n +0, ) 


12' 


(3.2) 


(3.3) 


where  uE  is  the  flexible  linear  displacement  at  the  end¬ 
point  of  the  flexible  beam  ( LINK2 ) . 

Having  defined  the  coordinates  transformation  for  the 
flexible  beam,  as  given  in  the  above  Equations  3.2  and  3.3, 
Lagrange's  equations  can  normally  be  derived.  In  order  to 
develop  a  mathematical  model  for  the  proposed  system  the 
flexible  displacement  u(x2,t)  must  be  given  by  a  closed  form 
expression. 

In  general  for  any  arbitrary  point  of  the  flexible  beam 
the  corresponding  flexible  displacement  u(x2,t)  that  will  be 
superposed  to  the  hypothetical  motion  of  the  two  rigid  links 


Figure  3.2  Vector  position  for  an  arbitrary  point  P 
the  flexible  beam  of  the  planar  robot  arm. 


system  can  be  expressed  using  the  so  called  assumed-mo 
method.  The  assumed-modes  method  was  described  in  detail 
Ref.  10.  In  the  case  of  a  free  vibration  problem  the  bas 


idea 


series  composed  of  a  linear  combination  of  admissible 
functions  f^  multiplied  by  time  dependent  generalized 
coordinates  q^(t) .  By  admissible  function  is  meant  any 
arbitrary  function  of  the  spatial  coordinates  satisfying  all 
the  geometric  or  essential  boundary  conditions.  Then  for 
the  case  of  the  flexible  displacement  of  LINK2  it  is 
possible  to  assume  that: 

n 

u  =  2  f,  (x_)  g.  (t)  (3.4) 
i=l  ^  i 

where  the  admissible  function  f^(x2)  roust  satisfy  the 
geometric  boundary  conditions  with  respect  to  the  represent¬ 
ation  of  LINK2  in  the  reference  frame  [01,X2,Y2]. 

From  the  above  it  is  clear  that  the  assumed-modes 
method  treats  a  continuous  system  as  an  n-degrees  of  freedom 
system.  Therefore  the  degrees  of  freedom  for  the  overall 
system  will  be  increased  from  2  to  n+2,  and  the  new  system 
will  be  represented  with  n+2  generalized  coordinates  that 
are  0^,  02  and  g^  where  i=l,2,...,n. 

Increasing  the  number  of  degrees  of  freedom  by 
increasing  n,  the  estimated  natural  frequencies  of  the 
system  will  approach  the  true  natural  frequencies  from 
above.  Using  a  large  value  for  n  for  a  more  accurate  model 
of  the  flexible  beam,  the  number  of  the  generalized  coordin¬ 
ates  will  also  increase  making  the  analysis  of  the  system 
and  the  derivation  of  the  mathematical  model  through 
Lagrange's  equations  a  very  unrealistic  approach.  The 
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system  can  be  simplified  with  the  assumption  that  the  ampli¬ 
tudes  of  the  higher  modes  for  the  flexible  link  are  very 
small  compared  with  the  amplitudes  of  the  first  modes. 
Therefore,  as  was  indicated  in  Ref.  5,  the  higher  modes  can 
be  neglected  and  the  system  can  be  truncated  with  n=2 , 
resulting  in  a  four-degrees  of  freedom  problem.  In  order  to 
verify  the  stated  assumption,  that  the  modes  with  n>3  can  be 
neglected,  the  eguations  of  motion  are  derived  in  Appendix  B 
for  a  planar  robot  arm  having  only  one  flexible  link  by 
using  the  Lagrangian  dynamics  method.  The  elastic  motion  of 
the  flexible  beam  that  will  superposed  to  the  hypothetical 
rigid  motion  of  the  arm  will  have  a  flexible  displacement 
approximated  by  the  assumed-modes  method.  In  Appendix  B, 
models  were  developed  for  this  flexible  planar  robot  arm 
using  the  assumed  modes  with  n=l,2  and  3  respectively.  The 
resulting  models  were  used  with  the  adaptive  control  scheme 
(derived  in  Chapter  V)  in  the  simulation  studies  of  this 
flexible  beam.  Three  different  DSL  programs  were  written 
for  these  simulation  studies,  with  the  source  programs  given 
in  Appendix  C.  The  resulting  phase  plane  and  step  response 
plots  in  the  cases  where  n=l,2  and  3  are  shown  in  Figures 
3.3  to  3.8.  From  the  analysis  presented,  comparing  the 
results  obtained  for  the  different  cases  of  n  used  one  can 
observe  that  the  step  responses  for  n=2  (Fig.  3.8)  and  for 
n=3  (Fig.  3.8)  have  essentially  the  same  duration  and  almost 
the  same  oscillatory  characteristics.  Thus  it  was  concluded 


_ max 

r*  *-  «■ 


Figure  3.3  Phase  plane  of  the  flexible  beam  (n=l) . 
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that  the  use  of  the  value  n=2  for  the  assumed-modes  was  a 


satisfactory  assumption.  Due  to  the  previous  analysis 
Equation  3.4  can  be  truncated  obtaining  the  form: 

u  =  f1(x2)  g±(t)  +  f2(x2)  (t)  (3.5) 

with  the  flexible  displacement  and  velocity  at  the  end  of 
the  LINK2  given  as: 

UE  -  flEgl+  f2Eg2  <3‘6) 

UE  =  flEgl+  f2Eg2  t3-7) 

From  that  point  the  derivation  of  the  Lagrange's 
equations  becomes  a  solvable  but  also  lengthy  and  tedious 
problem.  Forming  the  Lagrangian  function  L,  from  the 
general  form  of  the  Lagrange's  equation 

ft  -  -§57  -  «i  2 ,3,4  (3.8) 

SqL 


a  set  of  four  nonlinear  second  order  differential  equations 
can  be  derived,  where  the  generalized  coordinates  will  be 
given  as  qi=0i,  q2=®2'  93=<3l  anc^  c34=<?2*  From  the  definition 
of  the  generalized  coordinates  for  the  proposed  system  it  is 
possible  to  show  that  the  generalized  forces  obtain  the 
values  Q1=r1,  Q2=r2  and  Q3=Q4=0,  where  and  r2  are  the 
torques  applied  to  the  motors  at  J0INT1  and  J0INT2 
respectively . 

With  the  complete  derivation  of  the  Lagrange's  equati¬ 
ons  given  in  Appendix  D,  the  final  orm  of  the  differential 
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equations  that  describe  the  system  and  that  will  be  used  as 
the  basic  model  through  that  thesis  will  be  given  as 
follows : 


ri  (Dlll+Jl*  61  +D122G2  +D133gi  +°144g2 
+D112ei02  +D1139igi  +D1140ig2 


+D122292  +D12392gi  +D124®2g2  +  D1 


r2  D2119l  +(D222+J2)02  +°233gi  +D244g2 


+D2139igi  +D2149ig2 


+D22302gi  +D22402g2  +C>211101  +D2 


°  D3119l  +D32202  +°333gi  +D344g2  +D312G192 

+D3111G1  +D322292  +°3 


°  °4 1 1® 1  +D422®2  +°433gi  +°444g2  +D4129102 

+D411191  +D4222®2  +°4 


where 


D122+(mi+rn2)1l+m21l12COS02'm21iSin02UE 

m212+m2UE+m21l12COS02"m21lSin02UE 


m21lCOS02flE+m212flE 


m2ilCOS02f2Efm212f2E 


(3.9) 


(3.10) 


(3.11) 


(3.12) 


=  -2m2l1 (cos02UE+l2sine2 ) 


=  2m2flE(UE-1Xsin02) 


=  2m2f2E(UE"1lsin02) 

=  -m2l1 (l2sin©2+cos02UE) 


[  (m1+m2)  l1cos01+m2l2cos(01+e2)  -m2UEsin(ei+02)  ]g 


m212+m2UE 


°223  2m2flEUE 


°224  2m2f2E°E 


ltl212flE 


m212f2E 


m21l12Sin02+in21lCOSe2UE 


[m212COS(0l+02) _m2UESin(0l+02) ]g 


=  m2f1(l1cos02+l2; 


m212flE 


m2flE 


m2flEf2E 


=  -2m2flEUE 


=  -m2flEUE 


D3111  =  D3222+m21lflESine2 

°3  =  <?m2flECOS(0l+e2)“KWigi 

°422  =  m212f2E 

°411  =  D422+n21lf2ECOS02 

°433  =  °344 

°444  "  m2f2E 

°412  =  ”2lIl2f2EUE 

D4222  =  -m2f2EUE 


°4 111  =  D4222+m21lf2ESin02 


°4  =  gm2f2ECOS(9l+e2)"KW2g2 


KW  =  El 


KW2  =  El 


'12 

0 

rl2 

0 


f1(x)  f1(x)  cix 


f  2  ( x )  f  2  (x)  <ix 


J1  =  the  inertia  of  the  motor  at  JOINT  1 


J2  =  the  inertia  of  the  motor  at  JOINT  2 


g  =  the  acceleration  of  gravity  (=  9.814  m/sec  ) 

UE  =  flEgl+f2Eg2  =  end-P°int  displacement 

E  is  the  Young's  modulus,  and  I  is  the  second  moment  of  area 
of  the  beam  cross  section. 

The  admissible  functions  f^  (i=l,2)  are  assumed  to  be 
the  eigenfunctions  of  a  clamped-free  beam.  According  to 
Ref. 11  the  restrictions  for  the  geometric  boundary  conditi- 
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ons  will  be  satisfied  because  of  the  orthogonality  of  these 
functions: 


f  (x)  f  (x)dx  =  [  f  (x)  f  (x)dx  =  I  J  ' 
J0r  s  J0  L  x  '  r_- 


(3.13) 


with 

fr(x)  =  cosh(Mrx) -cos(/irx) -ar[sinh(Mrx) -sin(Mrx)  ]  (3.14) 

where,  r  is  the  mode  of  vibration. 
sinh(u  x) -sin(u  x) 


r  cosh (Mrx) +cos (Mrx) 

with  sinh  and  cosh  to  be  the  hyperbolic  sine  and  cosine 
functions  respectively,  given  as: 


sinh(x)  = 


cosh(x)  = 


x  -x 

e  -  e 


x  ~x 

e  +  e 


(3.16) 


(3.17) 


Because  the  model  takes  into  account  only  two  modes  for 
the  vibration  of  the  flexible  beam,  the  superscript  r  will 
obtain  the  values  1  and  2.  The  values  for  Mr  and  °r>  a*- 
end-point  of  the  flexible  beam  where  x  =  1,  will  then  be  as 
given  in  Table  3.1. 

TABLE  3.1  CHARACTERISTIC  VALUES  FOR  A  CLAMPED-FREE 
BEAM. 


n  =  4  l 
r  'r 

1.8751 


4 . 6941 


0.7341 


1.0185 


Because  of  the  orthogonality  identity  of  the  assumed- 
modes  the  flexible  component  of  the  potential  energy  will  be 
evaluated  as  follows: 


KW  =  -fl- 


r=l,  2 


(3.18) 


with  El  the  beam  stiffness,  ir  the  density  per  unit  length 
and  nr  the  flexible  value  given  above  for  the  rth  mode. 
Therefore  the  values  of  the  flexible  components  KW^  (i=l,2) 
of  the  potential  energy  can  be  computed,  and  they  will  be 
given  in  Table  3.2. 

TABLE  3.2  PARAMETERS  FOR  THE  ELASTIC  COMPONENTS  OF  THE 
POTENTIAL  ENERGY. 


r 

KWr 

1 

0.00124 

2 

0.0433 

The  other  parametric  values,  lengths  of  the  links  and 
discrete  masses  that  are  lumped  at  the  end  of  each  link, 
that  will  bt.  used  in  this  thesis  for  the  study  of  the  two 
links  planar  robot  arm  (with  the  first  link  rigid  and  the 
second  flexible)  are  given  in  Table  3.3. 

The  ( i=l  ,2,3,4)  values  defined  in  the  above 
equations  were  obtained  from  the  forces  acting  on  each  link 
due  to  acceleration  and  velocity  of  the  moving  robot  arm  as 
was  done  in  the  case  of  the  two  rigid  links  planar  robot 
arm.  Additional  terms  are  due  to  the  forces  introduced  by 
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PRELIMINARY  STUDIES  USING  THE  COMPUTER  SIMULATION  MODEL 


A.  INTRODUCTION 

The  second  order  models  derived  in  Chapters  II  and  III 
for  the  rigid-rigid  and  rigid-flexible  planar  robot  arms 
respectively  will  become  the  mathematical  models  for  this 
case.  Each  arm  will  be  driven,  open  loop,  by  a  servo  motor. 
The  servo  motors  have  to  follow  a  predetermined  curve  until 
the  desired  position  is  reached.  In  order  to  achieve  this 
the  states  of  the  second  order  model  have  to  be  adapted  such 
that  the  computer  model  mimics  the  position  and  the  velocity 
of  the  actual  servo  motor  with  equivalent  gain  constants. 

For  the  sake  of  the  analysis  identical  servo  motors  are 
used  independently  at  each  joint  to  provide  the  proper 
torques  for  the  required  movements. 


B.  SERVO  MOTOR  SELECTION 

From  Ref.  12  the  equivalent  transfer  function  of  a 
servo  motor  can  be  expressed  as: 


9  ( s ) 


1/KV 


V(S)  s  (s  +1)  (s  +1) 


(4.1) 


KvKt  R 

with  the  parameters  9,  V,  Kv,  Kt,  J,  R  and  L  obtained  from 
the  data  of  the  specific  motor  to  be  used.  For  the  purpose 
of  this  thesis  a  permanent  magnet  motor  drive  currently  used 
in  industrial  robots  was  selected.  The  parametric  data  for 
this  motor  obtained  from  Ref.  13  are  listed  in  Table  4.1. 


TABLE  4.1 


PARAMETRIC  DATA  FOR  THE  JOINT  SERVO  MOTOR. 


Torque  constant 

Kt: 

10.37 

gr-m/amp 

Motor  inertia 

Jm: 

0.024 

gr-m-sec2 /rad 

Damping  coefficient 

®m: 

0.031 

gr-m-sec/rad 

Back-emf  constant 

Kv: 

0.1012 

V-sec/rad 

Armature  inductance 

L  : 

0.0001 

H 

Terminal  resistance 

R  : 

0.91 

n 

Adding  a  large  inertia  to  represent  the  arm  of  the  robot  to 
the  motor  inertia  given  above  the  mechanical  pole  of  the 
motor  becomes  very  small.  Since  R/L  represents  a  large 
number  the  electrical  pole  of  the  motor  becomes  large  with 
no  significant  effect  on  the  response  of  the  servo  motor  and 
can  be  neglected.  Therefore  the  transfer  function  of  the 
servo  motor  can  be  approximated  as: 


G(s) 

V(s) 


(4.2) 


where  the  value  of  Km  will  be  computed  from  the  preliminary 
studies  of  the  arm-motor  systems  given  below. 

C.  ANALYSIS  OF  THE  ARM-MOTOR  SYSTEMS 
1 .  Riaid-riqid  Planar  robot  arm 

The  inertia  of  each  arm  will  be  given  from  and 

D22  <  as  they  are  defined  in  Chapter  II,  for  the  first  and 


the  second  link  respectively.  Evaluating  the  expressions  of 


Di  2.  and  D22  from  the  parametric  data  given  in  Table  2.1  and 
adding  the  result  to  the  inertia  of  the  servo  motor  used  at 
each  joint  (in  this  particular  case  the  motor  inertia  Jm  is 
the  same  for  both  joints),  the  effective  joint  inertias  can 
be  evaluated.  Knowing  the  effective  joint  inertias  at  each 
joint  the  exact  transfer  function  for  each  motor  will  be 
calculated.  The  inertia  of  the  first  arm  is  also  a  function 
of  the  angle  02  of  the  second  link,  solving  for  the  case 
©2=0 *  the  effective  joint  inertias  become: 

J i  =  D11+Jml  =  65.92+0.024  =  65.944  gr-m-sec2/rad ,  and 

J2  =  D2  +Jm2  =  5.12+0.024  =  5.144  gr-m-sec2/rad . 

Substituting  the  effective  inertias  calculated  above  and  the 
parametric  data  for  the  servo  motor,  given  in  Table  4.1, 
into  the  Equation  4.1  the  transfer  functions  for  the  two 
servo  motors  will  be  obtained  as  follows: 


9  •  88 

G1(S)  =  s  (S/9100  +1)  (s/0.016  +1)  rad/volt 


(4.3) 


9  •  88 

G2(S)  =  s  (s/9100  +1)  (s/0.204  +1)  rad/ volt 


(4.4) 


The  open  loop  Bode  plots  for  the  servo  motors  acting  at  each 
joint  were  obtained  using  the  software  package  'CONTROLS' 
with  the  resulted  plots  are  shown  in  Figures  4.1  and  4.2. 
From  the  Bode  plots  it  can  be  observed  that  the  gain  curves 
of  both  servo  motors  have  a  slope  of  -40  db/dec  and  their 
gain  crossover  frequencies  are  02=0.402  and  n2=1.43  rad/sec 
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respectively.  These  results  indicate  that  the  electrical 
pole  can  be  neglected  and  the  approximation  of  an  ideal 
motor,  with  its  transfer  function  given  as  Equation  4.2,  is 
valid  for  both  systems.  In  order  to  have  the  same  gain 
crossover  frequency  for  the  ideal  motor,  the  error  coeffic¬ 
ient  Km  must  have  the  value  Km^  =  n^2  (i=l,2).  Therefore 
the  error  coefficients  for  the  second-order  ideal  motors 
have  the  values  Km-j_=0.162  and  Kiri2=2.045  respectively.  The 
frequency  responses  of  the  ideal  motors  using  the  error 
coefficients  calculated  above  are  given  in  Figures  4.3  and 
4.4. 

2 .  Rigid-flexible  planar  robot  arm 

The  general  idea  of  the  previous  analysis  for  the 
case  of  a  rigid-rigid  planar  robot  arm  is  not  affected  by 
changing  the  second  link  to  be  a  flexible  one. 

The  inertia  of  each  arm  will  now  be  given  from 
Dlll  and  °222'  as  theY  are  defined  in  Chapter  III,  for  the 
rigid  and  the  flexible  link  respectively.  In  this  case 
evaluation  of  Dm  and  D222  is  not  so  simple  because  in 
their  expressions  are  also  involved  terms  due  to  the  elastic 
motion  of  the  flexible  arm.  To  overcome  that  problem 
different  approaches  were  used  to  obtain  the  frequency 
response  of  the  arm-motor  system  for  each  arm. 

For  the  rigid  arm  due  to  the  nature  of  the  system 
and  observing  the  quantities  involved  in  the  expression  of 
the  inertia  of  the  arm,  Dm,  the  "flexible"  terms  can  be 
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neglected.  Therefore  the  inertia  of  the  arm  can  be  computed 
using  the  parametric  data  given  at  Table  3.3  in  Chapter  III. 
With  02=0°  again,  and  adding  the  result  to  the  inertia  of 
the  servo  motor,  Jm^,  the  effective  joint  inertia  can  be 
evaluated: 

Jf^  =  =  58.75+0.024  =  58.774  gr-m-sec2 /rad 

Knowing  the  effective  inertia  at  J0INT1  the  exact  transfer 
of  the  motor  will  be  calculated.  Substituting  the  effective 
inertia  and  the  parametric  data  for  the  servo  motor  (given 
in  Table  4.1)  into  Eguation  4.1  the  transfer  function  for 
the  servo  motor  acting  at  J0INT1  is  obtained  as  follows: 

9  •  88 

Gfl(s)  =  s  (s/9100  +1)  (s/0.018  +1)  rad/volt  (4.5) 

The  open  loop  Bode  plot  for  this  servo  motor  was  obtained 
and  the  resulteing  plot  is  given  in  Figure  4.5.  The  gain 
curve  of  the  servo  motor  again  has  a  slope  of  -40  db/dec 
with  gain  crossover  frequency  at  nf 2=0. 431  rad/sec.  In 
order  that  the  ideal  motor  have  the  same  gain  crossover 
frequency,  the  error  coefficient  Kmf2  must  have  the  value 
Kmf 2=nf 22=0 . 185 .  The  frequency  response  of  the  ideal  motor 
using  the  calculated  error  coefficient  is  given  in  Figure 


4.6. 


In  the  case  of  the  flexible  arm  the  "flexible" 


terms  are  significant  and  they  cannot  be  neglected.  A 
satisfactory  approach  in  terms  of  the  frequency  response  is 
to  uncouple  the  flexible  arm  from  the  rigid  arm.  With  the 
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Figure  4.6  Open  loop  Bode  plot  of  the  ideal  motor  Km^/s 
(rigid-flexible,  case) . 
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flexible  arm  uncoupled,  the  transfer  function  given  in 
Ref.l  can  be  used  after  appropriate  scaling  to  represent  the 
flexible  beam  with  the  parametric  values  of  mass,  length  and 
strength  used  in  this  study.  The  transfer  function  that 
describes  the  system,  flexible  arm  and  motor,  can  be 
obtained  by  combining  the  two  transfer  functions  and  its 
final  form  is: 

585130  (s+l±j  30)  ( s+3 . 2± j 170)  (s+9.1±j462) 
Gf2(s)=  s ( s+0 . 3 )  (s+9100)  ( s+1 . 8± j 12  0 )  (s+4±j215)  (s+7.3±j481) 

(4.6) 

The  open  loop  Bode  plot  was  obtained  for  the  transfer 
function  of  the  flexible  arm-motor  system,  with  the  plot 
given  in  Figure  4.7.  One  can  observe  that  the  gain  curve 
has  a  slope  that  is  approximately  -40  db/dec,  and  the  gain 
crossover  frequency  is  f2f2=1.52  rad/sec.  In  the  frequency 
response  are  also  shown  three  resonant  frequencies  due  to 
the  elastic  motion  of  the  flexible  arm.  The  magnitude  at 
the  resonant  frequencies  is  decreasing  in  amplitude  with  the 
first  resonance  occurring  at  about  120  rad/sec.  For  the 
case  of  the  ideal  motor  the  response  at  high  frequencies  can 
be  neglected.  In  order  to  have  the  ideal  motor's  response 
at  the  same  gain  crossover  frequency  the  error  coefficient 
Kmf2  must  have  the  value  Kmf 2=nf ^2=2 . 34 .  The  frequency 
response  of  the  ideal  motor  using  the  error  coefficient 
calculated  above  is  shown  in  Figure  4.8. 


RIGID-FLEXIBLE  PLANAR  ROBOT  ARM 


(*»P)  ZSVHd 


01  01*-  o*oo-  oiot-  eni-  01**-, 


01*  01*  01  0U-  0‘0C-  01*-  0*00-  0**0- 


(ap)  aamiMDVH 

Figure  4.7  Open  loop  Bode  plot  of  the  arm-motor  at  JOINT2 
(rigid-flexible,  case) . 
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V.  VELOCITY  CURVE  FOLLOWER  CONTROL  SCHEME 


A.  BACKGROUND 

A  commonly  used  modification  of  a  bang-bang  controller 


is  the  "curve  following"  servo  [Ref. 14] 


The  "curve 


following"  control  scheme  usually  involves  three  modes  of 
operation  in  following  a  step  position  command.  There  are 
an  initial  full  acceleration  mode,  a  curve  following  mode 
and  a  terminal  linear  servo  mode.  The  nice  feature  of  this 
control  scheme  is  that  the  amplifiers  used  are  intentionally 
being  driven  into  saturation  resulting  in  fast  response  and 
taking  full  advantage  of  the  available  power  in  the  motor, 
which  is  being  driven  with  full  forward  or  full  reverse 
power.  This  is  the  main  advantage  compared  to  linear 
controllers  where  saturation  of  the  amplifiers  must  be 
avoided  because  it  renders  the  controller  ineffective. 
Other  advantages  of  this  control  scheme  are  its  implement¬ 
ation  on  a  digital  machine  and  the  adaptive  capabilities 
which  were  discussed  at  the  introduction  in  Chapter  I. 


B.  DESCRIPTION  OF  THE  VELOCITY  CURVE  FOLLOW  SYSTEM 

The  velocity  curve  following  control  scheme  is  illustr¬ 
ated  in  Figure  5.1.  The  control  scheme  that  will  be  used 
has  two  modes  of  operation  in  following  a  step  input 
command.  It  can  be  shown  that  the  commanded  input  does  not 
have  to  be  a  step.  Actually  any  input  command  (of  arbitrary 


i 


shape)  can  be  used  with  the  proposed  control  scheme. 

Initially  the  system  gets  into  full  acceleration  until 
the  designed  curve  is  reached,  at  which  point  the  system 
follows  the  curve.  The  velocity  curve  follow  control  scheme 
is  therefore  a  nonlinear  control  scheme  and  practically  it 
is  a  modification  of  a  bang-bang  controller. 

When  an  input  is  applied  to  the  system,  the  resulting 
error  signal,  E,  will  enter  the  curve  as  the  "distance  to 

go"  producing  as  output  the  corresponding  velocity  ordinate 

•  • 

of  the  curve,  X.  This  velocity  X,  becomes  the  input  of  the 
velocity  loop.  The  "Saturation  Amplifier",  saturates  and  a 
full  forward  signal  is  applied  to  the  motor.  As  the 
position  error  signal  decreases,  the  output  from  the  curve 
is  reduced  and  the  velocity  feedback  signal,  KC,  increases 
until  the  velocity  error,  XE,  becomes  zero.  Zero  velocity 
error  means  that  the  acceleration  trajectory  crosses  the 
designed  curve.  From  that  point  the  velocity  error  reverses 
sign,  causing  the  input  voltage  to  the  motor  to  reverse,  and 
the  system  decelerates  following  the  curve  down  until  it 
reaches  the  final  position. 

C.  DESIGN  OF  THE  CURVE 

The  curve  used  in  any  curve  follow  control  scheme  must 
have  a  shape  that  fits  the  requirements  for  the  specific 
system  and  the  application  of  that  system. 

For  the  purpose  of  this  study  the  curve  will  have  a 


parabolic  shape.  The  equations  describing  this  curve  can  be 


derived  from  the  equations  of  the  ideal  motor  as  follows: 


C  =  K  V  . 

m  sat 


C  -  |  C " dt  =  KVsatt+C(0) 


r  *  i 

-  J  cat  =  i 


KmVSatt2+=<°)t+Cl°> 


(5.1) 


(5.2) 


(5.3) 


Solving  Equation  5.2  for  t  and  substituting  its  expression 
into  Equation  5.3,  after  some  algebraic  manipulations  and 
with  the  initial  conditions  C(0)=0  and  C(0)=0,  the  following 
equation  is  obtained: 


KmVsat 


(5.4) 


For  deceleration  of  the  system  from  initial  conditions,  with 


the  input  R=0,  then: 


C  =  -E 


C  =  -E 


(5.5) 


(5.6) 


Combining  Equations  5.4,  5.5  and  5.6,  finally: 


X  =  A  J  E 


where 


A  =  /  2K  V  v 
m  sat 


X  =  E 


(5.7) 


Therefore  the  output  of  the  curve  that  represents  the 
commanded  velocity  can  be  generated  at  any  instant  of  time 
from  the  multiplication  of  the  square  root  of  the  position 
error  by  the  defined  constant  factor  A.  This  constant 
factor  will  be  initially  calculated  from  the  specific 
parameters  Km  and  Vsa-j-  and  its  value  stored  in  the  memory  of 
a  digital  computer.  The  gain  constant  of  the  second  order 
model,  Km,  is  determined  by  the  actuator  parameters  and  the 
effective  inertia  seen  by  the  actuator  and  is  updated 
through  the  adaptive  algorithm.  The  initial  values  for 
these  gain  constants  have  been  derived  in  Chapter  IV  for  two 
different  cases  of  a  planar  robot  arm  with  two  links,  the 
rigid-rigid  and  the  rigid-flexible. 

The  saturation  limits,  VSat>  of  the  amplifier  are 
determined  by  the  available  servo  motor  parameters,  the 
mechanical  design  of  the  arm  of  the  manipulator  and  the 
working  conditions.  The  gain  parameter  K2  must  have  a 
relatively  large  value  in  order  to  saturate  the  amplifier 
even  for  small  commanded  velocity  signals. 

The  gain  parameter  Klf  used  to  reshape  the  curve  as  a 
weight  factor  of  the  commanded  velocity  signal,  and  the 
feedback  gain  K  will  be  used  in  the  velocity  curve  follow 
model  in  order  to  give  best  system  performance  and  suitable 
results  for  each  specific  problem.  The  calculations  of  the 
values  of  K  and  K1  will  be  based  on  the  simulation  results. 


D.  SIMULATION  STUDIES  OF  THE  CONTROL  SCHEME  MODEL 

To  demonstrate  the  good  performance  of  the  basic  model, 
shown  in  Figure  5.1,  and  the  ability  of  the  velocity  curve 
follow  control  scheme  to  follow  the  designed  curve,  the 
model  was  simulated  using  DSL/VS.  The  DSL/VS  simulation 
program  is  listed  in  Appendix  E. 

The  basic  model  was  simulated  with  different  values 
corresponding  to  each  link  of  the  planar  robot  arm,  for  both 
cases  the  rigid-rigid  and  the  rigid-flexible.  The  resulted 
four  sets  of  parameters  are  given  in  Table  5.1. 

TABLE  5.1  RESULTED  PARAMETERS  FROM  THE  SIMULATION  STUDY 
OF  THE  BASIC  MODEL. 


Rigid-Rigid 

Rigid-Flexible 

LINK  1 

Km  =  0.162  rad/V 

vsat  =  ±300  V 

Km  =  2.045  rad/V 

vsat  =  ±150  v 

LINK  2 

Km  0.185  rad/V 

Vsat  =  ±300  V 

Km  =  2.340  rad/V 

Vsat  =  ±±50  V 

To  guarantee  the  saturation  of  the  amplifier  the  value 
K2— 10 , 000  was  chosen  to  be  used  at  the  simulation  studies 
for  all  the  different  cases. 


From  the  simulation  studies  the  appropriate  gain  values 
were  obtained  using  trial  and  error.  The  best  value  for  the 
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feedback  gain,  in  all  cases,  was  found  to  be  K=l.  For  the 
constant  weight  factor  Klf  the  values  0.8  and  1  gave  the 
best  system  performance  when  used  with  the  parameters 
corresponding  to  the  first  and  the  second  link  respectively. 

Simulating  the  basic  model  for  a  commanded  input  R=l 
rad  by  using  the  calculated  parametric  values  of  the  rigid- 
rigid  planar  robot  arm,  the  step  response  and  the  phase 
plane  trajectories  are  given  in  Figures  5.2  and  5.3.  Using 
the  parametric  values  (extracted  from  the  rigid-flexible 
planar  robot  arm)  the  corresponding  plots  are  given  in 
Figures  5.4  and  5.5. 

From  the  phase  plane,  where  the  trajectories  of  the 
angular  velocity  C  and  of  the  commanded  velocity  X  versus 
the  angular  position  C  are  given,  one  can  observe  that  the 
angular  velocity  increases  with  constant  acceleration  until 
the  curve  is  reached.  From  that  point  the  angular  velocity 
follows  the  designed  curve  until  the  desired  position  is 
reached.  Reaching  the  final  position  the  system  stops  with 
no  oscillations. 

The  step  responses  demonstrate  good  performance  of  this 
basic  model  with  fast  response  and  with  no  overshoots,  even 
for  this  relatively  large  commanded  input  signal. 


E.  THE  ADAPTIVE  MODEL 

The  block  diagram  of  the  adaptive  model  that  will  be 
used  in  controlling  the  two  links  planar  robot  arm  (at  both 
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cases)  is  illustrated  in  Figure  5.6.  The  output  signal  from 
the  saturating  amplifier  of  the  adaptive  model  is  common  to 
both  the  second  order  ideal  motor  and  to  the  actual  system 
that  is  a  combination  of  the  real  motor  and  the  arm  of  the 
manipulator.  Therefore  the  control  scheme  forces  the  actual 
system  to  follow  the  second  order  model  of  the  ideal  motor 
which  in  turn  is  adaptive  in  nature. 

The  angle,  TH,  of  the  manipulator's  arm  is  measured  at 
specified  time  intervals  and  the  resulting  value  is  used  in 
the  adaptive  algorithm  to  update  the  states  and  the  gain 
constant  of  the  second  order  model.  Figure  5.6  shows  that 
the  entire  control  scheme  and  the  adaptive  algorithm  can  be 
implemented  in  a  digital  computer  and  the  only  hardware 
requirement  for  the  proposed  system  will  be  the  device  that 
measures  the  angle  of  the  arm.  The  gain  constant  Km  of  the 
second  order  model  has  to  be  adjustable  in  order  to  account 
for  the  inertia  reflected  back  to  the  joint  due  to  the 
motion  of  the  arm.  The  adaptation  algorithm  for  Km  must 
satisfy  the  following  two  conditions: 

1)  The  calculations  must  be  accurate  to  allow  the 
states  of  the  second  order  model  to  approximate  the 
trajectory  of  the  actual  system. 

2)  The  required  calculations  must  be  kept  simple 
because  Km  must  be  updated  in  minimum  time  and  the 
algorithm  has  to  be  easily  programmed  in  a  computer. 


The  method  described  in  Ref  15  satisfies  the  above 


stated  conditions  and  will  be  used  in  this  analysis. 
Solving  Equation  5.3  for  Km,  with  zero  initial  conditions, 
the  following  expression  was  obtained: 


K  =  - - 

m  v  t^ 
sat 


(5.8) 


For  discrete  time  intervals  the  time  t  will  be  replaced  by 
the  product  NT  where  T  is  the  sampling  interval  and  N  the 
number  of  sampling  intervals.  By  also  letting  C=TH  Equation 
5.8  obtains  the  form: 


2  TH 

"  Vsat  <NT>2 


(5.9) 


Equation  5.9  for  Km  is  valid  only  for  constant  acceler¬ 
ation  of  the  system.  Therefore  the  gain  Km  will  be  updated 
during  the  full  acceleration  mode  and  until  the  velocity  of 
the  actual  motor  reaches  the  velocity  curve.  During  the 
curve  following  mode  Km  will  remain  unchanged. 

To  update  '-he  states  of  the  second  order  model  the 
adaptive  algorithm  requires  the  angular  position  and  the 
angular  velocity  of  the  actual  system.  The  actual  angular 
velocity  of  the  system  cannot  be  used  and  therefore  must  be 
estimated  from  the  measured  angular  position  of  the  system. 
Therefore  the  estimation  of  the  angular  velocity  will  be 
obtained  as  the  derivative  of  the  sampled  angular  position, 


that  in  discrete  representation  is: 
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TH (N)  = 


2  f TH ( N ) -TH(N-l) 


-  TH(N-l) 


(5.10) 


where  TH(N-l)  is  the  last  estimation  of  the  angular  velocity 


given  from: 


TH(N-l)  = 


TH(N) -  TH (N-2 ' 


(5.11) 


Equation  5.10  requires  the  storage  of  the  last  angular 
position  and  the  last  estimated  angular  velocity.  From 
Equation  5.11  it  is  clear  that  the  angular  velocity  can  be 
estimated  after  two  samples  of  angular  position  are  taken. 
Equation  5.10  is  not  self  correcting  if  the  system  switches 
from  full  acceleration  to  the  curve  following  mode,  until 
two  new  samples  of  the  angular  position  are  taken  after  the 
switching.  To  eliminate  this  problem,  the  switching  time 
has  to  be  detected  and  the  value  of  the  velocity  of  the 
second  order  model  at  that  time  must  be  stored  as  TH(N-l)  , 
in  order  to  be  used  at  the  next  calculation. 

The  storage  of  the  data  and  the  required  calculations 
as  given  in  Equations  5.10  and  5.11,  and  also  the  required 
checks  can  be  easily  programmed  in  a  microprocessor. 

This  adaptive  model  will  be  used  through  the  end  of 
this  thesis  at  the  simulations  of  the  two  links  planar  robot 
arm,  for  both  the  rigid-rigid  and  the  rigid-flexible  cases. 
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VI. 


SIMULATION  OF  THE  ADAPTIVE  MODEL 


A.  INTRODUCTION 

In  this  Chapter  simulation  results  will  be  obtained  for 
the  two  cases,  the  rigid-rigid  and  the  rigid-flexible,  of  a 
two  links  planar  robot  arm.  The  proposed  velocity  curve 
follow  adaptive  control  scheme  will  be  investigated  for  the 
case  of  the  rigid-flexible  two  links  planar  robot  arm  in 
order  to  examine  how  well  it  can  correspond  to  the  control 
requirements  of  the  model.  The  simulation  results  of  each 
model  will  be  examined  in  order  to  obtain  the  corresponding 
performance.  Finally  the  performance  of  the  two  different 
models  will  be  compared  as  well  as  the  equations  of  motion 
derived  for  each  model,  as  given  in  Chapters  II  and  III 
respectively. 


B.  COMPARISON  OF  THE  EQUATIONS  OF  MOTION 

The  equations  of  motion  that  describe  the  two  models 
were  given  as  Equations  2.2  and  2.3  in  Chapter  II  for  the 
case  of  the  two  rigid  links,  and  as  Equations  3.9  -  3.12  in 
Chapter  III  for  the  case  of  the  rigid-flexible  two  links 
planar  robot  arm. 

Comparing  the  two  sets  of  equations  one  can  observe 
that  the  second  order  differential  equations  obtained  by 
evaluating  Lagrange's  equation  with  respect  to  the  general¬ 
ized  coordinates  9^  and  02 ,  are  exactly  the  same  for  both 
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cases  except  that  some  additional  terms  are  included  in  the 
first  two  equations  of  motion  for  the  rigid-flexible  planar 
robot  arm  due  to  the  flexibility  of  the  second  link.  The 
number  of  additional  terms  is  proportional  to  the  number  of 
assumed-modes  used  to  express  the  elastic  motion  of  the 
flexible  beam.  The  other  terms  are  identical  because  they 
represent  the  same  rigid  motion  with  the  elastic  motion 
superimposed  this  rigid  motion,  for  the  case  of  the  rigid- 
flexible  planar  robot  arm. 

In  the  case  of  the  rigid-flexible  planar  robot  arm  n 
additional  second  order  differential  equations  will  be 
obtained,  by  evaluating  Lagrange's  equation  for  n  generali¬ 
zed  coordinates  g^  (i=l , 2 , . . . , n) ,  in  order  to  model  the 
elastic  displacement  of  the  flexible  link  using  n  assumed- 
modes  . 


C.  PLANNING  THE  SIMULATION  STUDIES 

The  sample  motion  used  to  investigate  the  performance 
of  the  two  links  planar  robot  arm  is  depicted  in  Figure  6.1. 
The  same  sample  motion  was  used  for  both,  rigid-rigid  and 
rigid-flexible,  combinations  of  the  two  links  planar  robot 
arm.  This  sample  motion  was  decided  in  order  to  remove  as 
many  of  the  nonlinearities  as  possible  and  to  investigate 
the  system  behavior  for  possible  overloading  conditions. 

A  step  input  with  amplitude  1.0  rad  was  used  to  drive 
the  two  motors  acting  on  J0INT1  and  J0INT2  respectively. 


In  order  to  have  a  more  complete  understanding  of  the 
system's  performance  the  sample  motion  of  the  two  links 
planar  robot  arm  in  the  simulation  studies  will  considered 
with  and  without  load  in  both  gravitational  and  gravity- 
free  environments.  The  case  where  the  sample  motion  will  be 
completed  in  two  successive  steps,  by  first  moving  only  the 
first  link  and,  when  its  final  position  is  reached,  then 
moving  the  second  link,  will  be  also  investigated  in  the 
simulation  studies. 

First,  a  complete  set  of  simulation  results  will  be 
obtained  for  the  case  of  the  two  rigid  links  planar  robot 
arm,  with  the  phase  plane  and  the  step  response  plots  given 
for  the  two  generalized  coordinates  6^  and  e2  corresponding 
to  the  angular  position  of  LINK1  and  LINK2  respectively. 

Similar  studies  will  investigate  the  performance  of  the 
rigid-flexible  planar  robot  arm,  with  plots  giving  the  end¬ 
point  displacement  as  well  as  the  phase  plane  and  the  step 
response  plots  for  each  of  the  two  angles  0^  and  02  of  the 
hypothetical  rigid  motion. 

D.  SIMULATION  OF  THE  RIGID-RIGID  PLANAR  ROBOT  ARM. 

The  simulation  results  for  the  two  rigid  links  planar 
robot  arm  are  given  in  Figures  6.2  -  6.13. 

Figures  6.2  and  6.3  are  the  phase  plane  and  the  step 
response  respectively  of  the  unloaded  arm  in  a  gravitational 
environment.  Considering  a  load,  equal  to  the  mass  of  the 
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Figure  6.7  Rigid-rigid  planar  robot  arm,  Step  response 
when  moving  only  LINK1  (arm  loaded) . 
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Figure  6.12  Rigid-rigid  planar  robot  arm,  Phase  plane 

(arm  loaded,  not  including  the  gravitational 
forces) . 


second  arm,  to  be  carried  from  the  manipulator  the  resulting 
phase  plane  and  step  response  plots  are  shown  in  Figures  6.4 
and  6.5  respectively.  To  complete  the  sample  motion  in  two 
successive  steps,  LINK1  is  moved  first  with  the  resulting 
phase  plane  and  step  response  plots  shown  in  Figures  6.6  and 
6.7  and  then  LINK2  is  moved  having  the  resulting  phase  plane 
and  step  response  plots  given  in  Figures  6.8  and  6.9, 
respectively.  When  the  sample  motion  of  the  two  rigid  links 
planar  robot  arm  is  considered  in  a  gravitational-free 
environment,  the  resulting  plots  when  the  manipulator  is 
unloaded  are  given  in  Figures  6.10  and  6.11.  Figures  6.12 
and  6.13  are  the  plots  corresponding  to  a  loaded  manipulator 
in  a  gravitational-free  environment.  In  the  gravitational- 
free  environment  cases  small  overshoots  occured  in  the 
response  of  the  angular  position  for  both  links,  especially 
with  the  manipulator  loaded.  The  reason  for  these  effects 
is  that  the  motors  were  selected  with  parametric  values  to 
satisfy  a  gravitational  environment.  Therefore  the  motors 
overdrive  when  no  gravitational  forces  are  included  in  the 
equations  of  motion.  The  two  links  accelerate  past  the 
deceleration  curve  which  then  cannot  slow  down  the  system 
enough  to  stop  at  the  desired  position.  This  causes  the 
small  overshoots  to  appear.  The  step  response  of  the  system 
for  any  of  the  above  situations  confirm  that  the  use  of  the 
velocity  curve  follow  as  the  control  scheme  of  a  two  rigid 
links  robot  arm  results  to  a  near  minimum  time  response. 
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E.  SIMULATION  OF  THE  RIGID- FLEXIBLE  PLANAR  ROBOT  ARM. 

The  model  of  the  rigid-flexible  planar  robot  arm  will 
be  tested  using  the  same  sample  motion.  For  the  particular 
situation  this  sample  motion  represents  the  hypothetical 
rigid  motion  with  the  elastic  motion  superposed  on  this 
motion.  For  the  case  of  the  rigid-flexible  planar  robot  arm 
in  the  simulation  results  the  plots  for  the  flexible  motion 
of  the  end-point  of  the  flexible  beam  will  be  also  obtained. 

Figures  6.14,  6.15  and  6.16  illustrate  the  phase  plane, 
step  response  and  elastic  motion  of  the  end-point  respec¬ 
tively  for  the  case  of  the  rigid-flexible  planar  robot  arm 
in  a  gravitational  environment  with  the  manipulator  not 
carrying  any  load.  The  plots  demonstrate  that  the  proposed 
velocity  curve  follow  control  scheme  is  fully  applicable 
with  the  system  of  a  planar  robot  arm  having  a  rigid  first 
link  and  a  flexible  second  link.  The  resulting  plots 
indicate  a  good  overall  system  performance  with  the  hypo¬ 
thetical  rigid  motion  being  completed  in  near  minimum  time. 
The  elastic  motion  of  the  flexible  beam  has  no  effect  in  the 
response  of  the  first  link,  that  actually  is  smoother  due  to 
a  lighter  second  link  as  compared  to  the  two  rigid  links 
case.  The  motion  produces  a  very  small  overshoot,  less  then 
2%,  in  the  response  of  the  flexible  link.  The  response  of 
the  overall  system  is  of  course  much  slower  due  to  the 
settling  time  required  for  the  elastic  motion  of  the 


flexible  beam. 
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Due  to  the  flexible  motion  of  the  end-point  this  time 
is  approximately  1.5  sec,  which  is  about  5  times  more  then 
the  required  time  for  the  rigid  motion.  Figure  6.16  shows 
that  the  end-point  is  displayed  in  a  negative  direction  with 
respect  to  the  center  line  of  an  equivalent  rigid  arm.  This 
is  due  to  the  bending  of  the  flexible  arm  as  it  is  ac¬ 
celerated.  No  other  vibrations  occur  in  the  response  of 
the  flexible  displacement. 

When  a  load  is  carried  by  the  manipulator  the  simula¬ 
tion  results  are  given  in  Figures  6.16,  6.17  and  6.18.  The 
load  carried  by  the  manipulator  is  equal  to  the  load  used  in 
the  simulation  studies  of  the  two  rigid  links  planar  robot 
arm,  resulting  a  load  that  is  approximately  50%  more  then 
the  weight  of  the  flexible  link.  Therefore  in  the  case  of 
the  rigid-flexible  planar  robot  arm  the  payload  will  be 
increased.  The  resulting  phase  plane  and  step  response 
plots  indicate  some  vibration  modes  acting  on  the  system  due 
to  the  increased  weight  of  the  flexible  beam.  The  effects 
of  these  vibrations  are  more  apparent  in  the  response  of  the 
flexible  beam  where  they  cause  some  overshoots  to  occur. 
Because  of  the  nature  of  the  system,  the  overshoots  in  the 
response  of  the  flexible  beam  are  not  constant  in  frequency 
and  amplitude.  The  reason  for  this  is  the  several  vibration 
modes,  due  to  the  elastic  motion,  acting  on  the  system  and 
the  coupling  effects  of  the  two  arms  during  the  hypothetical 
rigid  motion  of  the  system. 
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Figure  6.17  Rigid-flexible  planar  robot  arm,  Phase  plane 
(arm  loaded) . 
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These  coupling  effects  are  also  indicated  in  the 
response  of  the  rigid  arm,  where  some  vibrations  exist 
having  small  amplitudes.  The  vibrations  of  the  flexible  arm 
are  coupled  into  the  rigid  arm  and  increase  its  settling 
time.  When  the  flexible  arm  is  loaded  the  settling  time  of 
the  rigid  arm  is  about  1.0  sec,  which  is  greater  then  the 
settling  time  for  an  unloaded  arm  by  about  a  factor  of 
three.  This  is  also  the  required  settling  time  for  the 
hypothetical  rigid  motion  of  the  flexible  link.  The  actual 
settling  time  of  the  flexible  link  is  given  by  the  required 
settling  time  of  the  end-point.  Thus  the  settling  time  of 
the  flexible  arm  is  also  increased  by  the  load,  which  causes 
its  oscillation  to  last  about  2.1  sec.  The  load  also  tends 
to  cause  the  end-point  to  overshoot  the  desired  position. 
The  total  response  time  of  the  end-point  is  0.6  sec  longer 
when  the  arm  is  loaded.  The  additional  time  requirement  may 
be  acceptable  related  to  the  incresed  weight  of  the  flexible 
arm  due  to  the  load. 

For  the  sample  motion  to  be  completed  in  successive 
steps  the  requested  motion  for  only  the  rigid  arm  will  be 
first  completed,  followed  by  the  movement  of  the  flexible 
beam.  The  same  results  will  be  obtained  by  reversing  the 
order  of  the  successive  steps,  first  moving  the  flexible  arm 
and  when  its  motion  is  completed  moving  the  rigid  arm.  The 
resulting  plots  are  illustrated  in  Figures  6.20,  6.21  and 
6.22  for  the  phase  plane,  the  step  response  and  the  flexible 
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STEP  RESPONSE  (RIGID-FLEXIBLE  PLftNRR  ROBOT  RRM) 


Figure 


.21  Rigid-flexible  planar  robot  arm,  Step 
response  moving  only  the  rigid  link 
(arm  loaded) . 
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end-point  displacement  respectively  when  moving  the  rigid 
arm.  For  the  motion  of  the  flexible  arm  the  respective 
plots  will  be  shown  in  Figures  6.23,  6.24  and  6.25.  The 
required  time  to  complete  the  sample  motion,  by  adding  the 
time  that  is  required  to  complete  each  motion  of  the 
successive  steps,  is  approximately  4.0  sec.  Therefore  the 
settling  time  for  the  sample  motion,  when  using  the  method 
of  the  successive  steps,  will  be  twice  the  required  settling 
time  of  the  previous  simulations.  If  the  time  is  not  the 
only  important  requirement,  then  the  use  of  the  method 
described  above  will  give  some  advantages  in  the  performance 
of  the  system.  These  advantages  can  be  shown  in  the  phase 
plane  and  the  step  response  plots  of  the  two  motions.  From 
these  plots  one  can  observe  that  the  responses  of  the  rigid 
arm  and  the  flexible  arm  have  less  vibration  and  insignifi¬ 
cant  coupling  effects.  Thus,  the  resulting  response  for  the 
flexible  arm  has  much  smaller  overshoot  and  is  close  to  a 
linear  system  type  response.  That  was  expected  from  the 
simulation  results  for  a  planar  robot  arm  having  only  one 
flexible  link,  as  was  illustrated  at  Figures  3.5  and  3.6  in 
Chapter  III. 

When  the  rigid-flexible  planar  robot  arm  motion  is  to 
be  performed  in  a  gravitational-free  environment  (i.e., 
space  applications)  the  simulation  results  giving  the  phase 
plane,  the  step  response  and  the  flexible  displacement  of 
the  end-point  will  be  illustrated  for  the  unloaded  planar 


robor  arm  in  Figures  6.26,  6.27  and  6.28  and  for  the  loaded 
planar  robot  arm  in  Figures  6.29,  6.31  and  6.31. 


In  the  case  of  a  gravity-free  environment  the  response 
for  the  hypothetical  rigid  motion  of  the  unloaded  rigid- 
flexible  planar  robot  arm,  as  shown  at  the  phase  plane 
(Fig.  6.26)  and  the  step  response  (Fig.  6.27),  are  almost 
identical  to  the  results  obtained  for  the  two  rigid  links 
planar  robot  arm.  The  required  settling  time  of  the  overall 
motion  will  be  about  0.8  sec  due  to  the  required  settling 
time  for  the  end-point  flexible  displacement.  When  the  arm 
is  loaded  the  size  of  the  overshoots  occurring  in  the  system 
becomes  larger  and  the  required  settling  time  for  the 
overall  motion  increases  to  about  1.9  sec,  (that  is  about 
the  required  settling  time  of  the  unloaded  manipulator 
moving  in  a  gravitational  environment) . 

Therefore  in  a  gravity-free  environment  the  rigid- 
flexible  two  links  planar  robot  arm  gave  very  good  performa¬ 
nce  . 


F.  COMPARING  THE  SIMULATION  RESULTS 

Many  observations  can  be  made  by  comparing  the  obtained 
simulation  results  for  the  rigid-flexible  and  the  two  rigid 
links  planar  robot  arms. 

The  results  for  the  required  settling  time  of  the 
hypothetical  rigid  motion  of  the  rigid-flexible  robot  arm 
are  very  close  to  the  near  minimum  time  positioning  of  the 
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Figure  6.27 


Rigid-flexible  planar  robot  arm,  Step 
response  (gravitational-free  environment) 
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FLEXIBLE  MOTION  OF  THE  SECOND  ARM  (LINK  2) 


Figure  6.31 


Rigid-flexible  planar  robot  arm,  End-point 
displacement  (arm  loaded  -  no  gravitational 
forces  included) . 
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two  rigid  links.  The  hypothetical  rigid  motion  of  the 
rigid-flexible  robot  arm  resulted  in  overshoots  and  vibrati¬ 
ons,  that  are  highly  nonlinear  in  amplitude  and  in  frequen- 


i  cy.  The  reason  for  the  overshoots  is  that  the  system 

! 

;  presents  four  natural  frequencies,  two  rigid  and  two 

i 

I  flexible  as  the  model  takes  into  account  only  two  modes  of 
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the  flexible  beam,  combined  with  the  coupling  effects 
between  the  two  links.  By  lowering  these  frequencies  when 
increasing  the  load  of  the  flexible  link  these  effects  are 
more  pronounced.  The  stated  nonlinearity  in  the  system's 
response  can  be  observed  from  the  shapes  of  the  curves  for 
both  the  phase  plane  and  the  step  response  plots. 

From  the  plots  of  the  elastic  motion  of  the  system,  for 
the  end-point  displacement,  it  can  be  seen  that  accurate 
results  require  a  long  settling  time.  Another  interesting 
point  is  that  the  end-point  of  the  manipulator  bounces  back 
and  forth  from  its  final  position  slowly  but  not  many  times. 
That  indicates  a  good  control  of  the  flexible  components 
from  the  adaptive  model. 

In  the  case  where  the  sample  motion,  or  any  desired 
motion,  will  be  completed  in  successive  steps  by  moving  the 
links  one  at  a  time,  the  system's  performance  indicates 
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better  results  with  respect  to  the  accuracy  and  the  introdu¬ 
ced  vibrations.  In  this  case  the  required  settling  time  for 
the  completion  of  the  sample  motion  will  be  approximately 
twice  the  time  required  when  the  two  links  are  moving 
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simultaneously.  Therefore  once  more  a  decision  must  be  made 
based  on  the  requirements  of  the  specific  application. 
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For  the  case  where  no  gravitational  forces  are  included 
in  the  environment,  the  rigid-flexible  robot  arm  has  a 
better  performance,  not  very  different  from  the  one  obtained 
for  the  two  rigid  links.  Because  the  performances  are  not 
very  different,  the  other  advantages  of  the  flexible 
manipulator  make  its  use  more  advantageous  for  applications 
in  a  gravity-free  environment,  such  as  space  applications. 
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VII.  CONCLUSION  /  AREAS  FOR  FURTHER  STUDY 


As  a  result  of  the  research  conducted  in  this  thesis, 
the  control  of  the  rigid-flexible,  two  links  planar  robot 
arm,  using  the  curve  following  system,  appears  not  only 
possible  but  resulted  in  a  relatively  good  predicted 
performance  of  the  system. 

The  sample  motion  used  in  testing  the  adaptive  system 
introduced  relatively  large  inputs  for  both  links  of  the 
manipulator  in  order  to  examine  the  system  under  large 
parameter  variations. 

The  simulation  plots  indicate  that  the  system  provided 
very  good  steady-state  accuracy  (of  the  order  10E-3)  for  the 
elastic  motion  of  the  flexible  link  under  all  tested 
conditions.  The  steady-state  accuracy  was  independent  of 
the  load  of  the  flexible  link,  but  not  the  settling  time  of 
the  elastic  motion.  The  required  settling  time  of  the 
elastic  motion  for  all  cases  was  many  times  greater  than  the 
required  settling  time  of  the  hypothetical  rigid  motion. 
Which  was  approximately  equal  to  the  near  minimum  time 
positioning  of  the  two  rigid  links  planar  robot  arm. 

In  the  case  of  a  loaded  arm  increased  overshoots  with 
more  vibration  modes  were  introduced  in  the  angular  position 
of  the  arm.  This  problem  was  partially  alleviated  by 
completing  the  motion  in  successive  steps,  i.e.,  by  moving 
the  rigid  and  the  flexible  links  sequentially.  This 


solution  results  in  an  overall  increase  of  the  required 
settling  time  and  the  whole  situation  is  a  trade-off  between 
time  and  the  amount  of  oscillation. 

It  was  also  observed  that  for  the  case  of  the  direct 
drive  arm  that  was  used  as  the  model,  the  effects  of  the 
disturbance  torques  caused  by  the  elastic  motion  and  the 
coupling  inertia  between  the  two  links  as  well  as  the 
centripetal,  coriolis  and  gravitational  forces  acting  on  the 
robot  arm,  are  larger.  Therefore  the  servo  motor  must  apply 
larger  torques  which  implies  high  torque  constant  and  high 
armature  current  capabilities.  Due  to  the  lighter  structure 
of  the  flexible  link  the  torque  requirements  (for  both 
motors)  are  smaller  than  the  requirements  in  the  case  of  a 
two  rigid  links  planar  robot  arm.  Therefore  the  lighter 
rigid-flexible  planar  robot  arm  results  in  less  power 
consumption,  that  also  means  use  of  smaller  actuators. 

Combining  the  above  stated  main  advantage  with  the 
resulting  end-point  accuracy  (from  the  simulation  of  the 
adaptive  model)  the  rigid-flexible  manipulator  may  be  an 
attractive  solution  for  many  applications. 

Compared  with  a  two  rigid  links  planar  robot  arm,  the 
rigid-flexible  planar  robot  arm  may  be  preferable  in  many 
applications  especially  when  time  is  not  the  main  require¬ 
ment  and  also  in  gravity-free  environment  applications,  such 
as  space  applications. 
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An  area  for  further  study  arises  when  the  feasibility 
of  controlling  two  flexible  links  with  the  proposed  adaptive 
computer  simulation  model  is  to  be  investigated. 

Modelling  the  manipulator  both  links  were  assumed  to  be 
massless.  Another  area  for  further  study  arises  when  two 
links  having  their  masses  distributed  along  their  lengths 
are  used  to  build  a  robot  arm. 

Finally  a  very  interesting  area  for  further  study  will 
be  the  use  of  the  same  curve  following  method  as  the 
adaptive  control  scheme  but  with  curve  reshaping  through 
the  adaptive  algorithm  in  order  to  obtain  better  system 
performance. 
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DERIVATION  OF  THE  LAGRANGIAN  EQUATIONS  FOR  THE 
TWO  RIGID  LINKS  PLANAR  ROBOT  ARM 


I 


For  the  sake  of  the  analysis  the  configuration  of  the 


For  this  particular  system  the  generalized  coordinates 


are  Q±  and  02 ,  and  the  generalized  forces  r ]_  and  r2  as 
defined  in  Chapter  II.  To  form  the  Lagrangian  function  L, 
the  kinetic  and  potential  energies  of  the  system  must 
derived  in  terms  of  the  generalized  coordinates.  The 
kinetic  energy  of  any  multi-link  robot  arm  system  can  be 
obtained  from  the  kinetic  energies  of  the  individual  links, 
therefore,  for  the  two  links  robot  arm  system,  the  kinetic 
energy  T  will  be  the  sum  of  the  kinetic  energies  Tj_  and  T2 
of  LINK1  and  LINK2  respectively.  The  kinetic  energies,  T^ 
and  T2 ,  will  be  given  as: 


T.  = 


_1_ 

2 


i  2*2 


t2  -  -f-  v*2+*l> 


(A.  1) 

(A. 2) 


By  coordinates  transformation: 

x2=  l1cos01+  l2cos(01+©2)  ( A .  .'J ) 

Y2=  l^^sin©  +  l2sin(01+02)  (A. 4) 


Taking  the  derivatives  of  the  Equations  A. 3  and  A. 4  then: 


x2  =  -1^  sin©^  12  (©1+©2)  sin(©1+©2)  (A. 5) 

y2  =  l101cos©1+  12 (©1+©2) cos(©1+©2)  (A. 6) 


Substituting  Equations  A. 5  and  A. 6  into  Equation  A. 2,  after 
simple  algebraic  manipulations,  the  kinetic  energy  for  the 
second  link  is  given  by  the  following  equation: 


T2=  4*  I"2'1l®2l+12(®l+2®l®2+®2)+21l12<®i+®l®2)COS92J  <A'7> 

Therefore  the  kinetic  energy  of  the  system  will  be  given  as: 
T  =  -J-  [ (m1+m2) l2  42  +m2l2(42  +241e2+42)] 

(A.  8) 

+  ®21112(01  +ei02)cos02 


The  total  potential  energy  of  the  system  can  be 
computed  by  following  the  same  procedure  from  the  potential 
energies  of  the  individual  links,  given  as: 


V]_  =  m1gy1  =  m1gl1sinei  (A. 9) 

V2  =  m2gy2  =  m2g[:1lSin0l+12Sin(ei+02)  ]  (A. 10) 


Therefore  the  total  potential  energy  is: 


V  =  V1+V2  =  (m1+m2)gl1sinei+m2gl2sin(ei+e2)  (A. 11) 

Thus  the  Lagrangian  function,  L  =  T  -  V,  for  the  system 
of  the  two  rigid  links  planar  robot  arm  will  be  obtained 
from  Equations  A. 8  and  A. 11.  After  algebraic  manipulations 
the  Lagrangian  function  obtains  the  final  form: 


l  =  4-  +  4-  <"2i2+j2>4 


+  n,2(ll+12  +  21l12COSe2>4+"2(12  +  1l12COSe2)®l®2  <A'12> 


12 


-  [ (m1+m2) l1sinei+m2l2sin(01+e2) ]g 


From  the  above  derived  Lagrangian  function  L,  the  partial 
derivatives  of  L  with  respect  the  generalized  coordinates  0-^ 
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and  ©2  and  their  rate  of  change  ©^  and  ©2  will  give  the 
following  results: 


"f|p  =  -  (m1+m2)  gl1cos©1  -  m2gl2cos  (©^©.^ ) 


-^7"  =  (m1lJ+J1)©1  +  m2 (1^+12+21112cos©2)©1 
56, 


+  m2(l2+l1l2cos©2)©2 


d(5L  2  22  •  • 

_  (  =  (Tniii+ji+m2l1+m2l2+2m2l1l2cos©2)©1 

5e! 

+  0n212+In21l12COSe2)e2 


-  (2m2l1l2sin02)©1©2-  (m2l1l2sin©2)©2 

(SL  •  2  • 

<$©2  =  ~ ^m21l12sin92^ei  ~ ^m21l12Sin62^9l62 

-m2gl2cos(©1+©2) 

=  (m212+J2)02  +  ra2(1l+1l12COS02)ei 
5©2 

d  <$L  2  •  •  2  •  • 

dt  (~T_)  =  <m212+J2)92  +(m212+m21l12COS02)ei 
692 

-  n2l1l2sin02  ei©2 


(A. 13) 


(A. 14) 


(A. 15) 


(A. 16) 


(A. 17) 


(A- 18) 


A  set  of  two  nonlinear  second  order  differential 
equations  will  then  be  obtained  by  direct  substitution  of 


the  Equations  A. 13,  A. 15,  A. 16  and  A. 18  into  the  formula  for 
the  Lagrange's  equations: 


d_  SL  . 
dt  (  .  ; 


<SL 


<Sq. 


5qi 


=  Qi 


i=l,  2 


(A. 19) 


with  the  generalized  forces  to  be,  in  this  particular  case, 
Ql=ri  and  Q2=^2m  The  derived  pair  of  the  nonlinear  second 
order  differential  equations  was  given  in  Chapter  II  of  this 
thesis,  as  a  result  of  this  analysis. 


APPENDIX  B 


DERIVATION  OF  THE  MODEL  FOR  A  PLANAR  ROBOT  ARM  HAVING 
ONE  FLEXIBLE  LINK  USING  THE  ASSUMED-MODES  METHOD 

B1 .  GENERAL  REMARKS 

In  this  Appendix,  the  derivation  of  the  mathematical 
models  for  a  planar  robot  arm  having  one  flexible  link  will 
be  given,  with  the  flexibility  being  approximated  using  the 
assumed-modes  method.  The  set  of  the  second  order  differ¬ 
ential  equations  of  motion  that  describe  that  system  will  be 
derived  using  the  Lagrangian  dynamics  approach. 

The  Lagrangian  function  can  be  computed  as  L=T-V,  where 
T  and  V  are  the  kinetic  and  the  potential  energies  of  the 
system  respectively.  Therefore  the  Lagrangian  function  will 
be  derived  similar  to  the  method  followed  in  the  case  of  the 
flexible  second  link  of  the  planar  robot  arm,  as  will  be 
given  in  Appendix  D.  Expressing  the  Lagrangian  function  in 
terms  of  the  flexible  displacement  uE  the  following  equation 
are  obtained: 

L  =  — [ml2e2+  mQ2u2+  mu2]  +  ml0uE 

n  (B-1) 

.  1  2 
-  g[mlsin0+  mu  cos©]  -  — —  Z  (KW.g.) 

i=l  11 

where  n  =  1,  2  or  3 . 


With  the  above  derived  Lagrangian  function  L,  the  set  of  the 
differential  equations  that  describe  that  system  can  be 


obtained  by  forming  the  Lagrange's  equation  with  respect  the 


generalized  coordinates.  For  this  system  the  generalized 
coordinates  are  defined  to  be  9  and  g^  (i=l,  2  or  3 ) .  Thus 
sets  of  two,  three  and  four  nonlinear  second  order  differen¬ 
tial  equations  will  be  obtained  when  the  numbers  of  the 
assumed  modes  used  to  approximate  the  flexibility  are  n=l,2 
or  3,  respectively.  The  differential  equations  will  be 
obtained  by  forming  the  Lagrangian  equation,  as  is  given 
below: 


dt  1  ' 


i-1,2. 


(B.2) 


B2 .  EXPRESSING  THE  FLEXIBILITY  WITH  ONE  ASSUMED-MODE 

For  the  case  in  which  the  flexible  displacement  will  be 
expressed  using  one  assumed  mode  then: 


UE  “  flE9l 


(B.3) 


Replacing  the  above  expression  for  the  flexible  displacement 
the  Lagrangian  function  will  obtain  the  form: 

L  -  -§-  [mlV+  me2 


+  -  -5" 


-  g  [mlsin9+  m  {  f .  _,g.  )  cos©  ] 

11  -L 


(B.4) 


Forming  the  Lagrangian  equation  of  the  above  given 
Lagrangian  function  with  respect  the  generalized  coordinate 
9,  then: 


A\\v.vv  .v.\\ 

.  .  A  I'*  *  w 


<se 


=  -g  [ml0cos0  -  msin©f . ] 

lX*  X 


(B.5) 


r  T  o  *  •  •  o 

=  ml  0  +mlf1Eg1  +m0(f1Eg1) 
50 


(B.  6) 


d  XT  p  •  •  •  •  •  •  p  •  •  p 

( - — )=ml  9  +mlf1Egi  +m0  (f1Egx)  +  2m©  <i  (B.7) 
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The  same  approach  with  respect  the  generalized  coord¬ 
inate  g!  results  in: 


XT  *  P  P 

-8^1  =  me  gmf1Ecos0 


(B.  8) 


mflEgl+  ml0f1E 


(B.9) 


it  <— >-  + 


(B. 10) 


Combining  Eguations  B.5  and  B.7  the  first  nonlinear  second 
order  differential  equation  can  be  produced.  The  second 
nonlinear  differential  equation  will  be  derived  from  the 
Equations  B.8  and  B.10.  The  final  form  of  the  differential 
equations  that  describe  the  system  when  one  assumed  mode  is 
to  be  used  to  describe  the  flexibility  of  the  arm  will  be 
given  as  follows: 


r  =  Dlll9  +D122^1  +D112e  gi  +  D] 


°  =  D2119  +D222^1  +D21119  +  D; 


(B. 11) 


(B. 12) 


where 


Dlll  -  ”l2  +  m£lEgl 


°122  mlf IE 


°112  2mf lEgl 


D1  =  g[ml9  cose  -mf1Eg1sin0] 


D211  mlf IE 


°222  =  mflE 


°2 111  ~mflEgi 


D2  =  gmf1Ecos0  +  KW1g1 


KW  =  El 


fx(x)  fx(x)  dx 


Equations  B.ll  and  B.12  are  the  mathematical  model  used 
in  the  analysis  of  the  flexible  arm,  in  Chapter  III,  when 
the  flexible  displacement  is  to  be  expressed  with  one 
assumed-mode . 


B3 .  EXPRESSING  THE  FLEXIBILITY  WITH  TWO  ASSUMED-MODES 
Having  the  flexible  displacement,  uj?,  being  expressed 


with  two  assumed-modes  then: 


UE  “  flE9i  +  f2E*?2 


(B. 13 ) 


By  replacing  the  derived  expression  for  the  flexible 
displacement  the  Lagrangian  function  will  achieve  the  form: 

L  -  (ml2e2+me2(£1Eg1+f2Eg2)2+m(£1Eq1+f2Eg2)2] 


+  ml0(f1Eg1+f2Eg2) 


2 


(KW^+KW^) 


(B. 14 ) 


-  g [mlsine  +  f iEgi+ f 2Eg2 ) cos9] 

In  these  case  the  generalized  coordinates  are  ©,  g^  and 
g2 .  Therefore  a  set  of  three  second  order  differential 
equations  will  be  obtained  by  following  the  same  procedure 
as  was  illustrated  in  the  case  of  the  one  assumed-mode.  By 
taking  partial  derivatives  of  the  Lagrangian  function  with 
respect  each  generalized  coordinate  and  their  corresponding 
velocities  and  differentiate  with  respect  the  time  the 
following  equations  will  be  obtained: 


r  =  Dlll9  +D122gi  +°133g2  +D1129  gi  +D1139  g2  +°1  (B*15) 


0  D2110  +D222gi  +D233g2  +D21119  +°2 


°  D3119  +°322gi  +D333g2  +D31119  +°3 


(B. 16) 

(B.17) 


where 


Dlll 

- 

ml2  +  mf 

°122 

= 

mlflE 

°133 

= 

mlf2E 

°112 

= 

2mf iEgl+ 

°1 3  3 

= 

2mf2Eg2+ 

O 

H* 

II 

gmlGcos©  - 

°211 

= 

mlf  iE 

2  2,  *2  2 


'IE  2Ey2 
:!Ef2Egi 
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°222  =  mtlE 


°233  mflEf2E 


D2111  “mflE(flEgl+f2Eg2) 


D2  =  gmf 1Ecos©  +  KW1g1 


°311  mlf2E 


°322  °233 


°333  mf2E 


°3  111  -mf2E(flEgi'ff2Eg2) 


D3  =  gmf2Ecos0  +  KW2g2 


KW  =  El 


KW2  =  El 


0 

,1- 


f1(x)  fx(x)  dx 


f2(x)  f2(x)  dx 


The  derived  Equations  B.15,  B.16  and  B.17  will  become 
the  mathematical  model  of  the  flexible  arm,  for  the  analysis 
presented  in  Chapter  III,  when  two  assumed-modes  are  to  be 
used  to  express  the  flexible  displacement  of  the  arm. 


B4 .  EXPRESSING  THE  FLEXIBILITY  WITH  THREE  ASSUMED-MODES 

By  expressing  the  flexible  displacement,  ug,  with  three 
assumed-modes  then: 

UE  =  flE<?l  +  f2E*?2  +  f3E93  (B.18) 

Replacing  into  the  Lagrangian  function  the  approximation  of 
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the  flexible  displacement,  given  by  Equation  B.18,  the 
following  equation  is  obtained: 

L  =  2  [ml  e  +  m©  ^flEgl+f2Eg2+f3E^3^ 


+m(f lEgl+f2Eg2+f3Eg3^  ] +mle ( f iEgi+f 2Eg2+f 3Eg3 ^ 
-gtmlsine+m(f1Eg1+f2Eg2+f3Eg3)cos0] 


(B. 19) 


1"  (K^gJ  +KW2g^  +KW3g2) 


For  this  model  the  generalized  coordinates  are  0,  g3, 
g2  and  g3.  Therefore  a  set  of  four  nonlinear  second  order 
differential  equations  will  be  obtained  by  taking  partial 
derivatives  of  the  Lagrangian  function,  with  respect  to  each 
generalized  coordinate  as  well  as  with  respect  to  the  rate 
of  change  of  these  generalized  coordinates  and  different¬ 
iating  the  resulted  equations  with  respect  the  time.  This 
set  of  the  second  order  differential  equations  is  given  as: 


'nr 


311 


411 


122gl 

+D133g2 

+D144^3 

+D1129  g 

1 

# 

(B. 20) 

+D114G 

•  g3  +dx 

2  22gi 

+D233g2 

+D24493 

+D2111®2 

+  D2 

(B. 21) 

322gi 

+D333g2 

+D344g3 

+D311l82 

+  D3 

(B. 22 ) 

*4  2  2gi 

+D433g2 

+D444g3 

+D411102 

+  D4 

(B. 23) 

where 


□ill  -  ml2  +  m(flE9i+f2E92+f3E93) 2 
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v, 

V, 

v; 

v, 

»j> 


a 


5-.J 


'A 

V, 


U 


S 


i 

I 

» 
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*  mflEf3E 


*  -m£XE(£lE^l+£2E<32  +  £3E93> 


gmf1Ecos0  +  KW1g1 


=  mlf. 

°2  3: 
=  mf?. 


mf2Ef3E 


mf2E^flEgi+f2Eg2+f3Eg3) 


gmf?Ecos0  +  KW2g2 
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D~  =  D. 
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°4 111  -mf3E^flEgi+f2Eg2+f3Eg3^ 


d4  =  gmf3Ecose  +  Kw3g3 


KW1  =  El 


KW2  =  El 


KW3  =  El 


,1- 

d 

0 

,1. 

t 

0 

1. 


f-^x)  f]_(x)  dx 


f 2 (x)  f2(x)  dx 


f 3 (x)  f3(x)  dx 


The  derived  Equations  B.20  -  B.23  will  represent  the 
mathematical  model  of  the  flexible  arm,  when  the  flexible 
displacement  will  approximated  using  three  assumed-modes. 

B5 .  THE  MODELS  FOR  THE  FLEXIBLE  ARM 

A  planar  robot  having  one  flexible  rigid  arm  will  have 
a  mathematical  model  that  can  be  represented  by  the  models 
derived  previously.  All  these  models  are  very  similar 
because  they  were  based  on  the  same  idea  with  the  difference 
that  the  flexible  end-point  displacement  was  expressed  with 
one,  two  and  three  assumed-modes.  These  models  will  be  used 
with  an  adaptive  control  scheme,  the  velocity  curve  follow, 
that  will  be  derived  in  Chapter  V.  The  three  different 
models  that  will  be  resulted  will  be  simulated  in  order  to 
investigate  the  performance  of  the  flexible  arm. 
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APPENDIX  C 


SIMULATION  PROGRAMS  OF  THE  ADAPTIVE  MODEL  HAVING  A  FLEXIBLE 


ARM  TO  INVESTIGATE  THE  EFFECTS  OF  THE  ASSUMED  MODES 


Cl.  APPROXIMATION  USING  ONE  ASSUMED  MODE  (N=l) 


TITLE 

TITLE 

TITLE 

TITLE 

* 

CONST 

* 

PARAM 

PARAM 

PARAM 

PARAM 

PARAM 

PARAM 

PARAM 

PARAM 

PARAM 

PARAM 

PARAM 

PARAM 

* 

INTGER 

* 

INITIAL 


* 


SIMULATION  PROGRAM  FOR  THE  ADAPTIVE  MODEL  OF  A 
PLANAR  ROBOT  ARM  HAVING  ONE  FLEXIBLE  LINK. 

THE  FLEXIBILITY  WAS  APPROXIMATED  USING  ONE  ASSUMED 
MODE  (N=l) . 

G=981 . 4 

K=1 .0,K1=1.0;K2 =10000.0, KM=2 . 341 

KT= 1036.93 

VSAT=150 . 0 

J=2 .38 

KV=0. 1012 

BM=3 . 094 , LL=0 . 0001 , R=0 . 91 

KW1=0 . 57 

M=1 . 0 

L=3  2 . 0 

El-1.8751 

REF=1 . 0 

DT=0. 00025 

N , N 1 , FLAG , NCHK 


N=0 
N1=0 
FLAG=0 
Q1  =  0 . 0 
Q1D=0 . 0 
Q1DD=0. 0 
TH=0 . 0 
THD=0 . 0 
THDD=0 . 0 
TH1=0 . 0 

SIG1= ( SINH (El) -SIN (El) ) / (COSH (El) +COS (El) ) 
Fl=COSH (El) -COS (El) -SIG1* (SINH (El) -SIN (El) ) 
A=SQRT ( 2 . 0*KM*VSAT) 


DERIVATIVE 

RR=REF*STEP (0.0) 
ER=RR-P 

NOSORT 


*■;••**** 


k*  PARAMETERS  FOR  THE  EQUATIONS  OF  MOTION 
****************************************************** 

UE=F1*Q1 

D111=M* (L**2+UE**2 ) 

D112=2*M*F1*UE 
D12  2=M*L*F1 

D1=G*M* (L*COS (TH) -UE*SIN(TH) ) 

D2 11=M*L*F1 
D222=M*F1**2 
D2111=-M*F1*UE 
D2=G*M*Fl*COS (TH) -KW1*Q1 
*********************************************************** 

******  THE  LAGRANGE'S  EQUATIONS  OF  THE  SYSTEM  ******* 
*********************************************************** 
TL=D122  *Q1DD+D112  *THD*Q1D+D2 
Q1DD=(D21I*THDD+D2111*THD**2+D2)/D222 

************************************x********************** 

***********  the  adaptive  model  ************ 

*********************************************************** 

JTOT=J+Dlll 
IF  (ER.LT. 0.0)  THEN 

XD0T=-A*K1*SQRT ( ABS (ER) ) 

ELSE 

XD0T=A*K1*SQRT (ER) 

END  IF 

*********************************************************** 

************  FLEXIBLE  LINK  ************ 

*********************************************************** 

SORT 

XD=XDOT-K*PD 

V=LIMIT ( -VSAT , VS AT , K2  *XD) 

NOSORT 

IF  ( FLAG . EQ . 1 )  GO  TO  20 

IF  (V. LT. VSAT. AND. TIME. GT. 0. 0005)  FLAG=1 
NCHK=N1 

20  CONTINUE 

SORT 

PDD=KM*V 

PD=INTGRL (0.0, PDD) 

P=INTGRL (0.0, PD) 

VP=V-‘  (KV*THD) 

IM=REALPL (0.0, LL/R , VP/R) 

TM=KT *IM 

TNET=  JM-THD*  BM-TL 
THDD= ( 1 . /JTOT) *TNET 
THD=INTGRL (0.0, THDD) 

THD=INTGRL ( 0 . 0 , THD) 

*********************************************************** 

************  ASSUMED  MODES  ************ 

*********************************************************** 

Q1D=INTGRL ( 0 . 0 , Q1DD) 
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O  K.  “  » 


Q1=INTGRL(0 . 0 , Q1D) 

*********************************************************** 

***********  SAMPLING  THE  SYSTEM  *********** 

*********************************************************** 

SAMPLE 


NOSORT 


TERMINAL 

METHOD 


IF  (N.EQ.O)  GO  TO  30 
P=TH 

IF  (N.GE.2)  THEN 
TH1D= (TH-TH2 )  /  ( 2  . *DT) 

ELSE 
TH1D=PD 
END  IF 

IF  (FLAG . EQ . 0 )  THEN 

PD=(2 . * ( (TH-TH1) /DT) ) -TH1D 
IF  (N.GE.2)  THEN 

KM=DABS (2 . *TH/ (V* ( (N1*DT) **2) ) ) 
END  IF 
END  IF 

IF  (Nl.NE.NCHK)  THEN 

PD= ( 2 . * ( (TH-TH1) /DT) ) -TH1D 
END  IF 
N=N+1 
N1=N1+1 
TH2-TH1 
TH1=TH 


RKSFX 


CONTRL  FINTIM=2 . 0 , DELT=0 . 00005 , DELS=0 .00025 
SAVE  (SI)  0.005, XDOT , THD , TH 
* 

GRAPH  (Ll/Sl, DE=TEK618) 

TH ( LO=0 . 0 , SC= . 2 , LE=10 , NI  =  10 , UN= 1  RAD ' )  ,  .  . . 

THD (LO=-8 , SC=4 . 0 , LE=8 , NI=8 ) , . . . 

XDOT ( LO=-8 , SC=4 , LE=8 ,NI=8 , PO=10) 

* 

GRAPH  (L2/S1, DE=TEK618)  TIME (UN= ' SEC ')  ,  TH (UN= ' RAD  1 ) 

* 

LABEL  (LI)  PHASE  PLANE  OF  THE  FLEXIBLE  BEAM  (USING  1-MODE) 

LABEL  ( L2 )  STEP  RESPONSE  OF  THE  FLEXIBLE  BEAM  (USING  1-MODE) 
* 

END 

STOP 
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C2 .  APPROXIMATION  USING  TWO  ASSUMED  MODES  (N=2) 


TITLE  SIMULATION  PROGRAM  FOR  THE  ADAPTIVE  MODEL  OF  A 
TITLE  PLANAR  ROBOT  ARM  HAVING  A  FLEXIBLE  LINK. 

TITLE  THE  FLEXIBILITY  IS  APPROXIMATED  USING  TWO  ASSUMED 
TITLE  MODES  (N=2) . 

* 

CONST  G=98 1 . 4 

* 

PARAM  K=1 . 0 ,  Kl=l . 0 ,  K2=10000.0,  KM=2.341 

PARAM  KT=1036 . 93 

PARAM  VSAT=150 . 0 

PARAM  J=2 . 38 

PARAM  KV=0 . 1012 

PARAM  BM=3 .  094  ,  LL=0 . 0001 , R=0 . 91 
PARAM  M=1 . 0 

PARAM  L=3  2 . 0 

PARAM  El=l . 8751 ,  E2=^.6941 
PARAM  KW1=0. 00124,  KW2=0.0433 

PARAM  REF=1.0 

PARAM  DT=0. 00025 

* 

INTGER  N,  Nl,  FLAG,  NCHK 
★ 

INITIAL 

N=0 
N1=0 
FLAG=0 
QD=0. 0 
Q1=0. 0 
Q1D=0 . 0 
Q2=0 . 0 
Q2D=0 . 0 
Q2DD=0 . 0 
TH=0 . 0 
THD=0 . 0 
THDD=0 . 0 
TH1=0 . 0 

SIG1= (SINK (El) -SIN (El) ) / (COSH (El) +COS (El) ) 

SIG2= (SINK ( E2 ) -SIN(E2) ) / (COSH (E2 ) +COS ( E2 ) ) 
Fl=COSH ( El ) -COS (El) -SIG1* (SINH(El) -SIN (El p 
F2=COSH ( E2 ) -COS (E2) -SIG2* ( SINH ( E2 ) -SIN ( E2 ) ) 
A=SQRT ( 2 . 0*KM*VSAT) 

* 

DERIVATIVE 

RR=REF*STEP (0.0) 

ER=RR-P 


NOSORT 

**************************************************; 
******  PARAMETERS  FOR  THE  EQUATIONS  OF  MOTION 

UE=F1*Q1+F2*Q2 


D111=M* (L**2+UE**2) 

Dll 2 =2  *M*F1*UE 
D113=2*M*F2*UE 
D122=M*L*F1 
D13  3=M*L*F2 

D1=G*M* (L*COS (TH)  -UE*SIN(TH)) 

D211=M*L*F1 

D222=M*F1**2 

D233=M*F1*F2 

D2111=-M*F1*UE 

D2=G*M*F1*C0S (TH) +KW1*Q1 

D311=M*L*F2 

D322=D233 

D333=M*F2**2 

D3111=-M*F2*UE 

D3=G*M*F2*COS (TH) +KW2*Q2 

*********************************************************** 
******  THE  LAGRANGE'S  EQUATIONS  OF  THE  SYSTEM  ****** 

TL=D122*QD+D133*Q2DD+D112*THD*Q1D+D113*THD*Q2D+D1 

Q1DD=(D211*THDD+D233*Q2DD+D2111*THD**2+D2)/D222 

Q2DD=(D311*THDD+D322*QD+D3111*THD**2+D3)/D333 

QD=Q1DD 


*********** 


***********  THE  ADAPTIVE  MODEL  *********** 

*********************************************************** 

JTOT=J+Dlll 
IF  (ER.LT.0.0)  THEN 

XDOT=-A*Kl*SQRT (ABS (ER) ) 

ELSE 

XDOT=A*Kl*SQRT (ER) 

END  IF 


NOSORT 


20 

SORT 


FLEXIBLE  LINK 


XD=XDOT-K*PD 

V=LIMIT ( -VSAT , VSAT , K2  *XD) 

IF  (FLAG. EQ. 1)  GO  TO  20 

IF  (V. LT. VSAT. AND. TIME. GT. 0.0005)  FLAG=1 

NCHK=N1 

CONTINUE 

PDD=KM*V 

PD=INTGRL (0.0, PDD) 

P=INTGRL (0.0, PD) 

VP=V- (KV*THD) 

IM=REALPL (0.0, LL/R , VP/R) 

TM=KT*IM 

TNET=TM-THD*  BM-TL 
THDD= ( 1 . / JTOT) *TNET 
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THD=INTGRL (0.0, THDD) 

TH=INTGRL (0.0, THD) 

JcicicicicJcIcJcic'klc'klc'k'k'k'k'k'k'k’k'kic-k'k’k'k-k'k’k-k-k'k'klc’kic'k'kic'k'k'kicJe'k'k'kic'k'k'jc'k'k'k-k'k'k'k 

************  ASSUMED  MODES  ************* 

*********************************************************** 

Q1D=INTGRL (0.0, Q1DD) 

Q2D=INTGRL(0.0,Q2DD) 

Q1=INTGRL ( 0 . 0 , Q1D) 

Q2=INTGRL(0. 0,Q2D) 

*********************************************************** 
***********  SAMPLING  THE  SYSTEM  *********** 

ieieiciKieieieie^ieif-k-k'k'k'k-k'k-k’k’k’k’k-k'kieic’k'k'k'k'kicic'k'k'k'k'kic'k'kie'k'k'k-k'k'k’k'k'k'k'k'k’kie'kic 

SAMPLE 

NOSORT 

IF  (N.EQ.O)  GO  TO  30 
P=TH 

IF  (N.GE.2)  THEN 
THID= (TH-TH2 ) / ( 2 . *DT) 

ELSE 
TH1D=PD 
END  IF 

IF  (FLAG. EQ. 0)  THEN 

PD= (2 . * ( (TH-TH1) /DT) ) -TH1D 
IF  (N.GE.2)  THEN 

KM=DABS (2 . *TH/ (V* ( (N1*DT) **2) ) ) 

END  IF 
END  IF 

IF  (Nl.NE.NCHK)  THEN 

PD= ( 2 . * ( (TH-TH1) /DT) ) -TH1D 
END  IF 

30  N=N+1 

N1=N1+1 

TH2=TH1 

TH1=TH 


TERMINAL 

METHOD 

* 

CONTRL 
SAVE  (SI) 


RKSFX 

FINTIM=2 . 0 ,  DELT=0. 00005,  DELS=0. 00025 
0. 005,XDOT,THD,TH 


GRAPH  (Ll/Sl, DE=TEK618) 

TH  (  L0=0 . 0,  SC=.  2  ,  LE=  1 0  ,  NI  =  10  ,  UN=  '  RAD  '  )  ,  .  .  . 

THD ( LO=-8 , SC=4 . 0 , LE=8 , NI=8 ) , . . . 

XDOT ( LO=-8 , SC=4 , LE=8 ,NI=8 , PO=10) 

GRAPH  (L2/S1, DE=TEK618)  TIME (UN= ' SEC ')  ,  TH (UN= ' RAD  1 ) 

* 

LABEL  (LI)  PHASE  PLANE  OF  THE  FLEXIBLE  ARM  (USING  2-MODES; 
LABEL  ( L2 )  STEP  RESPONSE  OF  THE  FLEXIBLE  ARM  (USING  2-MODES; 


END 

STOP 
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C3 .  APPROXIMATION  USING  THREE  ASSUMED  MODES  (N=3) 

TITLE  SIMULATION  PROGRAM  FOR  THE  ADAPTIVE  MODEL  OF  A 
TITLE  PLANAR  ROBOT  ARM  HAVING  A  FLEXIBLE  LINK. 

TITLE  THE  FLEXIBILITY  IS  APPROXIMATED  USING  THREE  ASSUMED 
TITLE  MODES  (N=3) . 

* 

CONST  G=98 1 . 4 

* 

PARAM  K=1 . 0 ,  Kl=l . 0 ,  K2=10000.0,  KM=2.341 

PARAM  KT=103  6 . 93 

PARAM  VSAT=150 . 0 

PARAM  J=2 . 38 

PARAM  KV=0 . 1012 

PARAM  BM=3 . 094 ,  LL=0 . 0001 , R=0 . 9 1 
PARAM  M=1 . 0 

PARAM  L=32 . 0 

PARAM  El=l . 8751 ,  E2=4.6941,  E3=7. 85467 
PARAM  KW1=0. 00124,  KW2=0.0433,  KW3=0.357 

PARAM  REF=1 . 0 

PARAM  DT=0. 00025 

* 

INTGER  N,  Nl,  FLAG,  NCHK 


INITIAL 


N=0 
N1=0 
FLAG=0 
QD1=0. 0 
QD2=0 . 0 
Q1=0.0 
Q1D=0 . 0 
Q2=0 . 0 
Q2D=0. 0 
Q3=0. 0 
Q3D=0 . 0 
Q3DD=0 . 0 
TH=0 . 0 
THD=0 . 0 
THDD=0 . 0 
TH1=0 . 0 

SIG1= (SINH (El) -SIN (El) ) / ( COSH (El) +COS (El) ) 
SIG2= (SINH (E2) -SIN(E2) ) / ( COSH (E2 ) +COS (E2 ) ) 
SIG3= (SINH (E3 ) -SIN (E3) ) / (COSH (E3 ) +COS (E3 ) ) 
Fl=COSH (El) -COS (El) -SIG1* (SINH (El) -SIN (El) ) 
F2=COSH (E2 ) -COS (E2) -SIG2 * (SINH (E2 ) -SIN ( E2 ) ) 
F3=COSH(E3) -COS (E3) -SIG3* (SINH (E3) -SIN (E3) ) 
A=SQRT (2 . 0*KM*VSAT) 


DERIVATIVE 


RR=REF*STEP (0.0) 
ER=RR-P 


(4* 


NOSORT 

*********************************************************** 
******  PARAMETERS  FOR  THE  EQUATIONS  OF  MOTION  ****** 

*********************************************************** 
UE=F1*Q1+F2*Q2+F3*Q3 
D111=M* (L**2+UE**2) 

Dll 2  =  2  *M*F1*UE 

D113=2*M*F2*UE 

D114=2*M*F3*UE 

D122=M*L*F1 

D13  3=M*L*F2 

D144=M*L*F3 

D1=G*M* (L*COS (TH) -UE*SIN(TH) ) 

D211=M*L*F1 

D222=M*F1**2 

D233=M*F1*F2 

D244=M*F1*F3 

D2111=-M*F1*UE 

D2=G*M*Fl*COS (TH) +KW1*Q1 

D3 11=M*L*F2 

D322=D233 

D333=M*F2**2 

D344=M*F2*F3 

D3111=-M*F2*UE 

D3=G*M*F2*COS (TH) +KW2*Q2 

D4 11=M*L*F3 

D422=D244 

D433=D344 

D444=M*F3**2 

D4111=-M*F3*UE 

D4=G*M*F3*COS (TH) +KW3*Q3 

*********************************************************** 
******  the  LAGRANGE'S  EQUATIONS  OF  THE  SYSTEM  ****** 

*********************************************************** 
TL=D122*QD1+D133*QD2+D144*Q3DD. . . 

+D112*THD*Q1D+D113  *THD*Q2D+D114*THD*Q3  D+Dl 
Q1DD= ( D2 11*THDD+D2  3  3  *QD2  +  D2  44  *Q3DD . .  . 

-+  D2111*THD**2  +  D2)/D2  2  2 
Q2DD=(D311*THDD+D322*QD1+D344*Q3DD. . . 

+D3111*THD**2+D3)/D333 
Q3DD= ( D4 11*THDD+D4  2  2  *QD1+D4  3  3  *QD2 . .  . 

+D4111*THD**2+D4)/D444 

QD1=Q1DD 

QD2=Q2DD 


THE  ADAPTIVE  MODEL 


JTOT=J+Dlll 
IF  (ER.LT.O.O)  THEN 

XDOT=-A*Kl*SQRT (ABS (ER) ) 
ELSE 

XDOT=A*Kl*SQRT (ER) 


>VSVV* 


END  IF 

*********************************************************** 
*************  FLEXIBLE  LINK  ************* 

*********************************************************** 
SORT 

XD=XDOT-K*PD 

V=LIMIT ( -VSAT , VS AT , K2  *XD) 

NOSORT 

IF  (FLAG.EQ. 1)  GO  TO  20 

IF  (V. LT. VSAT. AND. TIME. GT. 0. 0005)  FLAG=1 
NCHK=N1 

20  CONTINUE 

SORT 

PDD=KM*V 

PD=INTGRL (0.0, PDD) 

P=INTGRL (0.0, PD) 

VP=V- (KV*THD) 

IM=REALPL (0.0, LL/R , VP/R) 

TM=KT*IM 

TNET=TM-THD* BM-TL 
THDD= ( 1 . / JTOT) *TNET 
THD=INTGRL (0.0, THDD) 

TH=INTGRL (0.0, THD) 

■k-k'k-k'k'k-k'k’kicie-k'k-k'k-kic'k-k-k'k’k'k'k'k'k'k-k'k'k'k'k'k'kicic’k'kic'kic-k'k'k'k'k'k’k'k'kie-k-k-k-k'kic-k'k 

************  ASSUMED  MODES  ************ 

*********************************************************** 

Q1D=INTGRL (0.0, Q1DD) 

<2  2  D=INTGRL ( 0 . 0 , Q2  DD) 

Q3  D=INTGRL ( 0 . 0 , Q3  DD) 

Q1=INTGRL (0.0, Q1D) 

Q2=INTGRL ( 0 . 0 , Q2D) 

Q3=INTGRL(0. 0,Q3D) 

*********************************************************** 

***********  SAMPLING  THE  SYSTEM  *********** 

*********************************************************** 

SAMPLE 

* 

NOSORT 

IF  (N.EQ.O)  GO  TO  30 
P=TH 

IF  (N.GE.2)  THEN 

TH1D= (TH-TH2 ) / ( 2 . *DT) 

ELSE 

TH1D=PD 
END  IF 

IF  ( FLAG . EQ . 0 )  THEN 

PD= ( 2 . * ( (TH-TH1) /DT) ) -TH1D 
IF  (N.GE.2)  THEN 

KM=DABS (2 . *TH/ (V* ( ( N 1 *  DT ) **2 ) ) ) 

END  IF 
END  IF 

IF  (Nl.NE.NCHK)  THEN 
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30 


PD= ( 2 . * ( (TH-TH1) /DT) ) -TH1D 
END  IF 
N=N+1 
N1=N1+1 
TH2=TH1 
TH1=TH 

TERMINAL 
METHOD  RKSFX 
* 

CONTRL  FINTIM=3 • 0 ,  DELT=0 . 00005 ,  DELS=0. 00025 
SAVE  (SI)  0.005, XDOT , THD , TH 
* 

GRAPH  (Ll/Sl , DE=TEK618 ) 

TH ( L0=0 . 0 , SC= . 2 , LE=10 , NI=10 , UN= 1  RAD ' )  ,  . .  . 

THD ( LO=-8 , SC=4 . 0 , LE=8 , NI=8 ) , . . . 

XDOT ( LO=-8 , SC=4 . 0 , LE=8 , NI=8 , P0=10) 

* 

GRAPH  (L2/S1 , DE=TEK618 )  TIME (UN= ' SEC ')  ,  TH (UN= ' RAD 1 ) 

* 

LABEL  (LI)  PHASE  PLANE  OF  THE  FLEXIBLE  ARM  (USING  3-MODES) 
LABEL  (L2 )  STEP  RESPONSE  OF  THE  FLEXIBLE  ARM  (USING  3 -MODES) 
* 

END 

STOP 
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APPENDIX  D 


DERIVATION  OF  THE  MODEL  FOR  A  TWO  LINKS  PLANAR  ROBOT  ARM 
HAVING  ONE  RIGID  AND  ONE  FLEXIBLE  LINKS 


In  this  Appendix,  a  complete  derivation  will  be  given 
for  the  mathematical  model  of  the  proposed  two  links  planar 
robot  arm  having  the  first  link  rigid  and  the  second  link 
flexible.  The  set  of  the  second  order  differential  equa¬ 
tions  of  motion  that  describe  the  proposed  system  will  be 
derived  using  the  Lagrangian  dynamics  approach.  For  the 
sake  of  the  analysis  Figure  3.2  given  in  Chapter  III, 
illustrating  the  coordinates  of  the  system  for  both  the 
rigid  and  the  flexible  links  will  be  repeated  as  Figure  D.l, 
in  order  to  give  a  better  understanding  in  the  derivation  of 
the  kinetic  and  the  potential  energies. 

The  Lagrangian  function  will  again  be  given  as  L=T-V, 
where  T  and  V  are  the  kinetic  and  the  potential  energies  of 
the  system  respectively.  The  kinetic  and  potential  energies 
will  derived  from  the  kinetic  and  potential  energies  of  the 
individual  links.  Therefore  T=T1+T2  and  V=V1+V2,  where 
T]_,V]_  and  T2,V2  are  the  kinetic  and  potential  energies  of 
the  rigid  and  the  flexible  link  respectively. 

The  kinetic  energy  for  the  rigid  link  will  be  given  as: 


.  2 '2 
mi1!0! 


(D.l) 
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Figure  D.l  Coordinates  configuration  of  the  (rigid- 
flexible)  two  links  planar  robot  system. 


The  kinetic  energy  of  the  flexible  link  will  be: 


T 


m2(X2  +  y2} 


(D.  2) 


where  x2  and  y2  are  the  end-point  Cartesian  coordinates  of 


the  flexible  beam.  The  transformation  to  the  generalized 
coordinates,  that  were  selected  to  describe  that  system,  was 
given  in  Chapter  III,  with  equations  3.2  and  3.3.  Taking 
the  derivatives  of  these  equations  the  velocity  components 
will  be  represented  as: 

•  •  •  • 

x2  =  -l1e1sinei  -  1  (01+©2) sin(0  +9  ) 

(D.3) 

•  •  • 

-  uEsin(ei+e2) -  uE(01+e2) sin(Q1+92) 


y  2  =  l191COS01  +  l2(01.02)COS(01+02) 


(D.4) 


-  uT?cos(©1+02)  -  uT?(01+0o)sin(©1+0o) 


E '  1  2‘ 


1  2  ‘ 


Taking  the  squares  of  the  above  equations  then: 


x2  =  1i0isin201+l2(01+02)2sin2(Q1+0o)+u2sin2(01+0^) 


rl 


12' 


2 __  2 


+ue(0i+02)  cos  (01+e2) +lil29l (0l+02) sin©1sin(01+02) 


+uEsin(01+02)  [I101sin©1+12  sin (0^02 )  ] 


(D.  5) 


+l1uE©1 (01+©2) sin01cos (01+©2) 


.  2 


+12UE(0l+02)sin  (0l+02) 


2  . 


+1  u  (©  +0  )  sin(9+0) cos (©-+©_) 


+uEuE(©1+02) sin(01+©2) cos(©1+©2) 


Y  2  =  1^0^cos201+l2 (©i+e2) 2cos2 (©1+©2)+u2cos2 (©1+©2) 


+U2  (0,  +0  )  2cos2  (0.  +0  )  +1  1_0.  (0  4-0  )  COS0  -  cos  (0.  +0_  ) 


+i1uE01co&e1cos(e1+e2)  +i2u£  (e^^+02)  cos^  (©1+02) 


'1lUE0l^0l+e2^  coseisin(ei+e2) 


(D.6) 


”12UE(ei+02)COS(ei+02) sin(ei+02) 

•  •  • 

-u£uE  (©^©^  cos  (O-j+e^  Sin  (©  +© ) 

Combining  Equations  D.5  and  D.6  into  Equation  D.2,  and  using 
trigonometric  identities  to  simplify  the  expression,  the 
kinetic  energy  for  the  flexible  link  obtains  the  form: 

T2  *  ~T~  Vl^l^l+02)2+  UE<0l+02>2 


+2111201 (01+©2) cos©2+  211ue©1cos©2 


(D.7) 


+212(©1+02)uE+  211uE01(©1+02)sin(-©2) ] 

To  obtain  the  final  form  of  the  kinetic  energy  for  the 
flexible  link,  the  flexible  displacement  uE  and  velocity  uE 
can  be  substituted  from  the  expressions  derived  in  Chapter 
III  as  given  by  Equations  3.6  and  3.7  respectively.  For 
motions  of  the  flexible  arm  in  the  range  -90°<©2<90°  then 
sin(-02)=  -sin©2.  Therefore  the  total  kinetic  energy  of  the 
system  is: 


T  ~  ~2~  [ini1l9l+m21l0l+IIl21l(0l+e2)2+m2(flEgi  +  f2Eg2)2] 
+  4“  m2(0l+02)2(flEgi+f2Eg2)2+in21l120l(0l+e2)COS02 
+  m21iei(flEgi+f2Eg2)COS02+in212(0l+e2)  (  f  lEgi+f  2E92  } 


( D  •  8  ) 


-  ViVW  <flEgl+£2Eg2)Slne2 


The  potential  energy  for  the  rigid  link  will  be: 


V1  =  gm1l1sin01 


(D.9) 


For  the  flexible  link  the  potential  energy  will  be  composed 
of  the  energy  associated  with  the  rigid  motion  plus  the 
elastic  potential  energy.  Assuming  the  magnitude  of  the 
elastic  motion  small  compared  to  the  overall  motion,  meaning 
small  amplitude  of  the  flexible  displacement  u,  the  potent¬ 
ial  energy  of  the  flexible  link  can  be  written  as: 


v2  =  gm2[i1sine1+i2sin(e1+e2)+uEcos(e1+e2) ] 


El  (■ 


<S2u  ' 


(D. 10) 


)  dx 


where  El  is  the  stiffness  of  the  flexible  link,  assumed 
constant  for  the  purpose  of  this  model. 

Substituting  the  flexible  displacement  uE  with  the 
equivalent  expression,  derived  in  Chapter  III,  given  by 
Equation  3.6,  the  integral  involved  in  the  potential  energy 
of  the  flexible  beam  can  be  evaluated  as  follows: 


1  2  i 

2  EI(— ^~)  dx=EI  f  2  (f  gi  +  f2g2)2dx=KW  g2+KW  g2 
o  j  0 


(D. 11) 


where 


KW1  =  El 


(fx  fx)  dx 


Having  derived  the  Lagrangian  function,  the  differential 
equations  that  describe  this  system  can  be  obtained  by 
forming  the  Lagrange's  equations  that  have  the  general  form 
given  from  Equation  3.8  in  Chapter  III.  For  this  particular 
system  the  generalized  coordinates  are  defined  to  be  0^,  02  , 
qi  and  g2 .  Therefore  a  set  of  four  nonlinear  second  order 
differential  equations  will  be  obtained  by  taking  partial 
derivatives  of  the  Lagrangian  function  with  respect  to  each 
generalized  coordinate  and  their  corresponding  velocities 
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and  differentiated  with  respect  to  time.  This  approach  with 
respect  to  0]_  gives: 


^  -  =  -[(m  +m  )1  cos©  +m  1  cos(0  +0  ) 


+  m2(f1Eg1+f2Eg2)sin(01+02)]g 


(D. 14 ) 


^  =  (m1+m2) 1l®1+m212 (®1+®2)+m2 (®!+®2) (flEg1+f2Eg2) ' 


<50, 


+m21l1202COS02  +  2in21l12eiCOSe2+in21l(flEgi+f2Eg2)COS02 


(D. 15) 


+m212 (flEgi  +  f2Eg2)  m21l02  ^ f lEgi+f 2Eg2 ^  sin02 


■2m21l0l(flEgi+f2Eg2)sin02 


d  6L>  2**  2**  2**  •  • 

dt  <~ J-OWVl  +V201  +”212e2  +m2ei  (flE9l+f2E92* 

<5©i 


-2  ' 


+2m20lflEgigi+2m20lflEf2Egig2+2m29lflEf2Eg2gi 


+  2m29lf2Eg2g2  +  2m202flEgigi  +  2ln202flEf2Egig2 


2  ’ 


+  2m292flEf2Eg2gi+2in202f2Eg2g2+m21l1202  COS0 


+  2m21l129l  COS02_ln21l1202  sin02-2m21l120l02Sin02 


(D. 16) 


+m2l1cos02(f1Eg1  +f2£g2  )'^21l92(flEgi+f2Eg2)sin0; 


+m212flEgi  +m212f2Eg2  ~m2 1 102 ( f lEgi+f 2Eg2 } sin0; 


-m21l02(flEgi+f2Eg2)COS02-m21l02Sin02(flEgi+f2Eg2) 


'2m21l(flEgl+f2Eg2) (91  sin02+0102cos02) 
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-2l"21ieiflEglSlnS2‘2ln21ieif2Eg2Slne2 


Combining  the  above  Equations  D.14  and  D.16  the  first  non¬ 
linear  second  order  differential  equation  can  be  derived,  as 
given  in  Chapter  III  by  Equation  3.9.  The  same  approach 
with  respect  to  ©2  gives: 

<SL 


S&2  -m21l120l (0l+02 ^ sin02~m21l0l^flEgi+f2Eg2^  sin02 


-m21iei(0i+02)  (fiEgl+f2Eg2)COS02_  g t^^cos  (©1+©2 )  (D.17) 


-m2(flEgi+f2Eg2)sin(0l+02)3 


m21202+m29l (flEgi+f2Eg2)  +m202 ( f lEgi+f 2Eg2 ) 


<S0. 


+m2l2 ( f iEgi+f 2Eg2 ^  m21l0l ^ f lEgi+f2Eg2 ^ Sin02  (D.18) 
+I"2120l+m21l12eiO°Se2 

d  <SL  2**  2  *  *  2**  2** 

dt  ^  ^-Itl2120l  +m21202  +m2  ^flEgi+f2Eg2^  91  +2lTl2 f lEgigi0l 

<502 

+2m2f lEf2Egig20l+2m2f lEf2Egig29l+2m2f2Eg2g20l 
+m2 ^flEgi+f2Eg2^  ®2  +2m2f lEgigi92+2m2f lEf2Egig202 
+2m2f lEf 2Egig292+2m2f2Eg2g202+m21l120l  cos02  (D-19) 

-m21l120l02Sin02+m212f lEgi  ~m21lf lE0igisin02 
_ra21lf2E0ig2Sin02-in212  *  f  lEgi+f  2Eg2  ^  ®1  sin02 


'm21l (flEgi+f2Eg2) 0l92COS02+m212f2Eg2 
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The  second  nonlinear  second-order  differential  equation  that 
describes  the  system  will  result  from  the  above  Equations 
D .  17  and  D.19,  having  the  final  form  given  by  the  Equation 
3.10  in  Chapter  III.  With  respect  to  the  generalized 
coordinate  g^  this  approach  gives: 


<5L 


2  2 
i  /-v  \  6 


=  VW  fIEgl+n2<0l+e2>  flEf2Eg2 
■m21iei(ei+e2)flESin02_gin2flECOS(ei+ei)+KWigi 


(  D .  2  0 ) 


AT  O  •  •  • 

—  *V£lEgl+£lE£2Eg2  +  1lVlECOSS2+VVe2>flE]  'D'21> 


dt  <  — »  =  m2£Lgl  +m2flEf2Eg2  +VlflEei  °OS82 

5gi 

_m21lf  lE0l02S‘‘"n02+in212flE0l  +m212f  IE®  2 


(D. 22 ) 


Combining  Equations  D.20  and  D.22  the  third  nonlinear  second 
order  differential  equation  can  be  produced  with  its  final 
form  given  in  Chapter  III  by  Equation  3.11.  The  last 
Equation  3.12  of  the  second  order  differential  equations 
given  in  Chapter  III,  can  be  derived  from  the  given  below 
(Equations  D.23  and  D.25).  These  equations  can  be  derived 
by  following  the  same  procedure  with  respect  to  the  fourth 
generalized  coordinate  g2 . 


<$g  m2^0l+02^  f 2Eg2+m2  ^0l+02^  flEf2Egi 


-m21l0l(0l+02)f2Esin02-gm2f2ECOS(9l+02)+KW2g2 


(D.23) 


> 

J 

I 

V 

w 


» 

s. 

V 

i 


k 


i 
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ixvwvxvvv v.’yv’wv ■ :.•* v* :v.mv.’..v.vv v  -  -  v  v vjvuwu 


m2  ^  f2Eg2  fflEf2Egi  +  1l0lf2ECOSe2  +  12  ^0l+02^  f2E^  (D.24) 


.  ^  m2f2Eg2  +m2flEf2Egl  +m21lf2E0l  cos02 
5g2 

+Itl212f2E0l  +m212f2E02  “m21lf 2E0l02Sin02 


(D. 25) 


APPENDIX  E 

SIMULATION  PROGRAM  FOR  THE  BASIC  MODEL  OF  THE 
VELOCITY  CURVE  FOLLOW  CONTROL  SCHEME 


TITLE  ADAPTIVE  VELOCITY  CURVE  FOLLOW  CONTROL  SCHEME 

* 

PARAM  K1=0 . 8 ,  K2=10000 . ,  KM=0.185,  VSAT=300.0,  K=l. 0 
PARAM  INP=1 . 0 

* 

INITIAL 

A=SQRT ( 2 . *KM*VSAT) 

VEL=0 . 0 

* 

DERIVATIVE 

R=INP*STEP (0.0) 

ER=R-C 

NOSORT 

IF  (ER.LT.0.0)  THEN 

VEL=-A*K1*SQRT (ABS (ER) ) 

ELSE 

VEL=A*K1*SQRT (ER) 

END  IF 

SORT 

DVEL=VEL-FBVEL 

FBVEL=K*CDOT 

AMP=LIMIT ( -VS AT , VS AT , K2*DVEL) 

CDDOT=KM*AMP 
CDOT=INTGRL (0.0, CDDOT) 

C=INTGRL (0.0, CDOT) 

* 

METHOD  RKSFX 

CONTROL  FINTIM=0 . 4 ,  DELT=0.0001 
SAVE  (SI)  0.001,  C,  CDOT,  VEL 

SAVE  (S2)  0.001,  C,  R 


GRAPH  (Gl/Sl , DE=TEK618 , P0=0 , 0) 

C ( LE=8 , NI  =  10 , SC=0 . 1 , UN= ' RAD 1 )  ,  .  .  . 

VEL ( LE=4 , NI=4 , L0=0 , SC=$AR, UN= ' RAD/ SEC ' ) , . . . 
CDOT ( LE=4 , NI=4 , L0=0 , SC=$AR , UN= ' RAD/SEC ' , PO=8 ) 
GRAPH  (G2/S2 , DE=TEK618 , OV , P0=0 , 5 ) 

TIME ( LE=8 , UN= ' SECOND '),... 

C ( LE=4 , NI=4 , L0=0 , UN= 1  RAD '  ,SC=0.5)  ,  .  .  . 

R ( LE=4 , NI=4 , L0=0 , SC=0 . 5 , AX=OMIT) 

LABEL  (Gl)  PHASE  PLANE 
LABEL  ( G2 )  STEP  RESPONSE 
END 
STOP 
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APPENDIX  F 


SIMULATION  PROGRAM  FOR  THE  TWO  LINKS 


f RIGID-RIGID^  PLANAR  ROBOT  ARM 


TITLE  SIMULATION  PROGRAM  OF  THE  ADAPTIVE  MODEL  FOR  THE 
TITLE  PLANAR  ROBOT  ARM  HAVING  TWO  RIGID  LINKS. 

* 

TITLE  THIS  PROGRAM  WAS  USED  FOR  THE  SIMULATION  RESULTS 

TITLE  FOR  THAT  SYSTEM,  WITH  OR  WITHOUT  LOAD  AS  ALSO 

TITLE  WITH  OR  WITHOUT  THE  GRAVITATIONAL  FORCES. 

* 

CONST  G=981 . 4 

CONST  ZL=0 . 0 

* 

PARAM  K1=0 . 8 , K2=10000 . , K3=l . 0 , KM 1=0 . 162 , KM2=2 . 045 , K=1 . 0 

PARAM  KT1=103  6 . 93 , KT2  =  103  6 . 9  3 

PARAM  VSAT1=3  00 . 0 , VSAT2  =  150 . 0 

PARAM  J1=2.38,J2=2.38 

PARAM  KV1=0. 1012, KV2=0. 1012 

PARAM  R1=0 . 91 , R2=0 . 91 , L=0 .0001 

PARAM  BM1=3 . 094 , BM2=3 . 094 

PARAM  Ll=40 . 0 , L2  =  3  2 . 0 

PARAM  Ml=3 . 0 , M2=0 . 5 

PARAM  REF1=1 . 0 , REF2=1 . 0 

PARAM  DT=0. 00025 


INTGER  N , N1 , N2 , NCHK1 , NCHK2 , FLAG1 , FLAG2 


INITIAL 


N=0 
N1=0 
N2=0 
FLAG1=0 
FLAG2=0 
P1=0.0 
P2=0 . 0 
P1D=0 . 0 
P2D=0 . 0 
TH1=0 . 0 
TH2=0 . 0 
TH11=0 . 0 
TH2 1=0 . 0 
TH1D=0 . 0 
TH2  D=0 . 0 
TH1DD=0. 0 
TH2DD=0 . 0 

A1=SQRT ( 2 . *KM1*VSAT1) 
A2=SQRT ( 2 . *KM2  *VSAT2 ) 


* 

DERIVATIVE 

RR1=REF1*STEP (0.0) 

RR2=REF2*STEP (0.0) 

RRD2=TRANSP (200 ,  0 . 0 , 0 . 1 , RR2 ) 

E1=RR1-P1 
E2=RRD2-P2 

NOSORT 

*********************************************************** 

******  PARAMETERS  FOR  THE  EQUATIONS  OF  MOTION  ****** 

*********************************************************** 

TH=TH1+TH2 

Dll= (M1+M2 ) * (Ll**2) +M2* (L2**2) +2*M2*L1*L2*C0S (TH2 ) 
D12=M2* (L2**2) +M2 *L1*L2 *COS (TH2 ) 

D2  2  =M2  * ( L2  *  *  2 ) 

D122=-M2*L1*L2*SIN (TH2 ) 

D112=D122 

D211=-D112 

Dl= (M1+M2 ) *G*L1*C0S (TH1) +M2*G*L2*COS (TH) 

D2=M2  *G*L2  *COS (TH) 

*********************************************************** 

**********  DIFFERENTIAL  EQUATIONS  ********** 

*********************************************************** 

TL1=D12*TH2DD+D122*TH2D**2+2*D112*TH1D*TH2D+D1 

TL2=D12*TH1DD+D211*TH1D**2+D2 

* 

JT0T1=J1+D11 
JTOT2=J2+D22 
IF  (El. LT .0.0)  THEN 

X1D0T=-A1*K1*SQRT ( ABS (El ) ) 

ELSE 

X1D0T=A1*K1*SQRT (El) 

END  IF 

IF  (E2.LT.0.0)  THEN 

X2DOT=-A2 *K3 *SQRT (ABS (E2) ) 

ELSE 

X2DOT=A2*K3*SQRT (E2 ) 

END  IF 

SORT 

*********************************************************** 

*************  LINK  1  ************* 

*********************************************************** 

X1D=X1D0T-K*P1D 

V1=LIMIT ( -VSAT1 , VSAT1 , K2  *X1D) 

NOSORT 

IF  (FLAG1.EQ.1)  GO  TO  5 

IF  (VI. LT.VSAT1. AND. TIME. GT. 0.0005)  FLAG1=1 
NCHK1=N1 
5  CONTINUE 

SORT 

P1DD=KM1*V1 
P1D=INTGRL (0.0, P1DD) 
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************** 


************** 


7 

SORT 


*********************************************************** 
X2D=X2DOT-K*P2D 
V2=LIMIT ( -VSAT2 , VSAT2 , K2  *X2D) 

NOSORT 

IF  (FLAG2.EQ.1)  GO  TO  7 

IF  ( V2.LT.VSAT2. AND. TIME. GT. 0.0005)  FLAG2=1 
NCHK2=N2 
7  CONTINUE 

SORT 

P2DD=KM2*V2 
P2D=INTGRL ( 0 . 0 , P2  DD) 

F2-INTGRL (0.0, P2D) 

VP2=V2-(KV2*TH2D) 

IM2=REALPL (0.0, L/R2 , VP2/R2 ) 

TM2  =KT2  * IM2 

TNET2=TM2-TH2D*BM2-TL2 
TH2 DD= ( 1 . / JTOT2 ) *TNET2 
TH2D=INTGRL (0.0, TH2DD) 

TH2=INTGRL( 0 . 0 , TH2D) 

*********************************************************** 

**********  SAMPLING  THE  SYSTEM  *********** 

******************************** 


******* 

******* 

. ** 

SAMPLE 

NOSORT 


IF  (N.EQ.O)  GO  TO  20 

P2=TH2 

P1=TH1 

IF  (N.GE.2)  THEN 

TH2 1D= (TH2-TH22 ) / ( 2 . *DT) 

TH11D= (TH1-TH12 ) / (2 . *DT) 

ELSE 

TH2 1D=P2  D 
TH1 1D=P1D 
END  IF 

IF  (FLAG2.EQ.0)  THEN 

P2D= ( 2 . * ( (TH2 -TH2 1 ) /DT) ) -TH21D 
IF  (N.GE.2)  THEN 

KM2=DABS (2 . 0*TH2/ (V2* ( (N2*DT) **2) ) ) 
END  IF 
END  IF 

IF  (N2 .NE.NCHK2)  THEN 

P2D= ( 2 . * ( (TH2-TH21) /DT) ) -TH21D 


! 


END  IF 

IF  (FLAG1.EQ.0)  THEN 

P1D=  ( 2  .  *  (  (TH1-TH11) /DT)  )  -THUD 
KM1=DABS (2 . *TH1/ (VI* ( (N1*DT) **2) ) ) 
END  IF 

IF  (N1.NE.NCHK1)  THEN 

P1D=(2  .  *  (  (TH1-TH11) /DT)  )  -THUD 
END  IF 
N=N+1 
N2=N2+1 
N1=N1+1 
TH22=TH2 1 
TH12=TH11 
TH2 1=TH2 
TH11=TH1 


TERMINAL 
METHOD  RKSFX 

* 

CONTRL  FINTIM=0 . 8 ,  DELT=0 . 00005 ,  DELS=0. 00025 

SAVE  (SI)  0. 005,X1DOT,P1D,TH1D,X2DOT,P2D,TH2D,TH1,TH2 , ZL 
SAVE  (S3)  0.005, PI, P2 , TH1 , TH2 , RR1 , RRD2 

* 

GRAPH  ( Ll/Sl , DE=TEK618 ) 

TH1 ( LE=8 , UN= ' RAD  * , L0=-0 . 1, SC=0 . 1 ,NI=12)  ,  . . . 

PID ( LE=4 , NI=8 , LO=-4 . , UN= ' RAD/SEC ' , SC=2 . , PO=8 ) , . . . 
X1DOT ( LE=4 , NI=8 , LO=-4 . , SC=2 . , UN= ' RAD/SEC ' ,AX=OMIT) , 
TH1D ( LE=4 , NI=8 , LO=-4 . , UN= ' RAD/SEC ' , SC=2 .),... 

ZL ( LE=4 , NI=8 , LO=-4 . , SC=2 . ,AX=OMIT) 

* 

GRAPH  ( L2/S1 , DE=TEK618 , OV, PO=0 , 5 ) 

TH2 ( LE=8 , UN= ' RAD ' , LO=- . 1 , SC= . 1 , NI=12 ) , . . . 

P2D ( LE=4 , NI=8 , LO=-4 . , UN= ' RAD/SEC ' , SC=4 . ,PO=8) , . . . 

X2  DOT ( LE=4 , NI=8 , LO=-4 . , UN= ' RAD/SEC ' , SC=4 . ,AX=OMIT)  , 
TH2D ( LE=4 , NI=8 , LO=-4 . , UN= ' RAD/SEC ' , SC=4 . ) , . . . 

ZL ( LE=4 , NI=8 , LO=-4 . , SC=4 . , AX=OMIT) 

* 

GRAPH  (L3/S3 , DE=TEK618)  TIME (LE=8 , UN= ' SEC '),.. . 

PI ( LE=4 , NI=4 , LO=- . 5 , UN= ' RAD  * , SC= . 5 , PO=8 )  ,  . .  . 

TH1 ( LE=4 , NI=4 , LO=- . 5 , SC= . 5 , UN= ' RAD '),... 

RR1 ( LE=4 , NI=4 , LO=- . 5 , SC= . 5 , AX=OMIT) 

* 

GRAPH  ( L4/S3 , DE=TEK618 , OV, P0=0 , 5 )  TIME ( LE=8 , UN= ' SEC ') , 
P2 ( LE=4 , NI=4 , LO=— . 5 , UN= ' RAD ' , SC= . 5 , PO=8 ) , . . . 

TH2 ( LE=4 , NI=4 , LO=- . 5 , UN= ' RAD ' , SC= . 5 ) , . . . 

RRD2 ( LE=4 , NI=4 , LO=- . 5 , SC= . 5 , AX=OMIT) 


LABEL 

LABEL 

* 

END 

STOP 


(LI)  PHASE  PLANE  (RIGID-RIGID  PLANAR  ROBOT  ARM) 

( L3 )  STEP  RESPONSE  (RIGID-RIGID  PLANAR  ROBOT  ARM) 


APPENDIX  G 


TITLE 

TITLE 

TITLE 

TITLE 

TITLE 

TITLE 

TITLE 

TITLE 

* 

CONST 

CONST 

* 

PARAM 

PARAM 

PARAM 

PARAM 

PARAM 

PARAM 

PARAM 

PARAM 

PARAM 

PARAM 

PARAM 

PARAM 

* 

INTGER 

* 

INITIAL 


SIMULATION  PROGRAM  FOR  THE  TWO  LINKS 


(RIGID-FLEXIBLE^  PLANAR  ROBOT  ARM 


SIMULATION  PROGRAM  FOR  THE  ADAPTIVE  MODEL,  USING 
THE  VELOCITY  CURVE  FOLLOW  CONTROL  SCHEME,  OF  A  TWO 
LINKS  PLANAR  ROBOT  ARM  HAVING  ONE  RIGID  AND  ONE 
FLEXIBLE  LINK,  USING  TWO  ASSUMED  MODES  TO  EXPRESS 
THE  ELASTIC  MOTION  OF  THE  FLEXIBLE  BEAM. 

THIS  SAME  PROGRAM  WAS  USED  TO  OBTAIN  SIMULATION 
RESULTS  WITH  THE  SYSTEM  TREATED  WITH  OR  WITHOUT 
LOAD,  AS  ALSO  WITH  OR  WITHOUT  GRAVITY  FORCES. 

G=981 . 4 
ZL=0 . 0 


K=1.0,K1=0.8,K2=1.0,K3=10000.0,KM1=0. 185,KM2=2.31 

KT1=1036 . 93 , KT2=1036 . 93 

VSAT1=300 . 0 , VSAT2=150 . 0 

Jl=2 . 38, J2=2 .38 

KV1=0 . 1012 , KV2=0 . 1012 

PM1=3 . 094 , BM2=2 . 094 , L=0 . 0001 , R=0 .91 

Ml=3 . 0 , M2=l . 0 

Ll=40 . 0 , L2=32 . 0 

El=l. 8751, E2=4. 6941 

KW1=0. 00124 ,KW2=0. 0433 

REF1=1 . 0 , REF2=1 . 0 

DT=0. 00025 

N , N1 , N2 , FLAG1 , FLAG2 , NCHK1 , NCHK2 


N=0 
N1=0 
N2=0 
FLAG1=0 
FLAG2=0 
Q1  =  0 . 0 
Q1D=0 . 0 
QD=0 . 0 
Q2  =  0. 0 
Q2D=0 . 0 
Q2  DD=0 . 0 
TH1=0 . 0 
TH1D=0 . 0 
TH1DD-0 . 0 
TH2=0 . 0 
TH2  D=0 . 0 
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TH2DD=0 . 0 
TH11=0 . 0 
TH2 1=0 . 0 

SIG1= (SINH (El) -SIN (El) )/ (COSH(El) +COS (El) ) 
SIG2= (SINH (E2 ) -SIN (E2 ) ) / (COSH (E2 ) +COS (E2) ) 
Fl=COSH (El) -COS (El) -SIG1* (SINH(El) -SIN (El) ) 
F2=COSH (E2 ) -COS (E2 ) -SIG2* (SINH (E2 ) -SIN (E2 ) ) 
A1=SQRT ( 2 . 0*KM1*VSAT1) 

A2=SQRT ( 2 . 0*KM2 *VSAT2 ) 


DERIVATIVE 

RR1=REF1*STEP (0.0) 

RR2=REF2 *STEP (0.0) 

RRD2=TRANSP (200 , 0 . 0 , 0 . 1 ; RR2 ) 

ER1=RR1-P1 

ER2=RRD2-P2 

NOSORT 

•k'k'k'k’kic'k'k'k'k-k'k-k-k’k'kic'k'k'k'k'k'k'k'kie-kie'k'k'k'k'k'kic'k'kicic’kic'krk’kic'k-k-k'k'k'kicic'k'k'kic-k-k 

******  PARAMETERS  FOR  THE  EQUATIONS  OF  MOTION  ****** 

*********************************************************** 


UE=F1*Q1+F2  *Q2 
TH=TH1+TH2 

D122=M2*L2**2+M2*UE**2+M2*L1*L2*C0S (TH2) . . . 
-M2*L1*SIN(TH2) *UE 

D111=D122+ (M1+M2 ) *L1**2+M2*L1*L2*C0S (TH2 ) . . . 

-M2*L1*SIN (TH2 ) *UE 
D133=M2*L1*C0S(TH2) *F1+M2*L2*F1 
D144=M2*L1*C0S(TH2) *F2+M2*L2*F2 
D112=-2  *M2*L1* (UE*C0S (TH2 ) +L2  *SIN (TH2 ) ) 
D113=2 *M2 *F1* (UE-L1*SIN (TH2) ) 

D114=2*M2*F2* (UE-L1*SIN (TH2) ) 

D1222=-M2*L1* (L2*SIN (TH2) +UE*COS (TH2 ) ) 

D123=D113 

D124=D114 

Dl= ( (M1+M2) *L1*C0S (TH1) +M2*L2*COS (TH) . . . 

-M2*UE*SIN(TH) ) *G 
D211=D122 

D222=M2*L2**2+M2*UE**2 

D2 13=2  *M2  *F1*UE 

D223=D213 

D214=2*M2*F2*UE 

D224=D214 

D233=M2*L2*F1 

D244=M2*L2*F2 

D2111=M2*L1* (L2*SIN(TH2) +UE*COS (TH2 ) ) 

D2=G*M2*(L2*COS(TH)-UE*SIN(TH) ) 

D311=M2*L1*F1*C0S (TH2 ) +M2  *L2  *F1 

D3  2  2=M2  *L2  *F1 

D333=M2*F1**2 

D344=M2*F1*F2 

D312=-2*M2*F1*UE 

D3222=-M2*F1*UE 


V  V  V  V  v V 


rtjr+r 


D3111=D3222+M2*L1*F1*SIN (TH2) 

D3=G*M2*F1*C0S (TH) +KW1*Q1 
D422=M2*L2*F2 

D411=D422+M2*L1*F2*C0S (TH2) 

D4  3  3  =  D344 

D444=M2*F2**2 

D412=-2*M2*F2*UE 

D4222=-M2*F2*UE 

D4 111=04 222+M2*Ll*F2*SIN(TH2) 

*********************************************************** 

******  the  LAGRANGE'S  EQUATIONS  OF  THE  SYSTEM  ****** 

*********************************************************** 

TL1=D122*TH2DD+D133*QD+D144*Q2DD+D112*TH1D*TH2D. . 
+D113*TH1D*Q1D+D114  *TH1D*Q2D+D12  3*TH2D*Q1D .  .  . 
+D124*TH2D*Q2D+D1222*TH2D**2+D1 
TL2=D2 11*TH1DD+D2  3  3  *QD+D2  44*Q2DD+D2 13  *TH1D*Q1D .  .  . 
+D214*TH1D*Q2D+D223*TH?D*Q1D+D224*TH2D*Q2D. . . 
+D2111*TH1D**2+D2 

Q1DD=(D311*TH1DD+D322*TH2DD+D344*Q2DD. . . 
+D312*TH1D*TH2D+D3111*TH1D**2 . . . 
+D3222*TH2D**2+D3) /D333 
Q2DD=(D411*TH1DD+D422*TH2DD+D433*QD. . . 
+D412*TH1D*TH2D+D4111*TH1D**2 . . . 
+D4222*TH2D**2+D4)/D444 

‘k'k'k'k'k'k'k'k'k'k'k-k-k-k'k-k'k-k'k-k'k-k’k-k-k'k-k-k'k’kjc'kJc-k-k-k-k’k’k'k'k'k'k-k’k'k’kic-k'k'k'k'k-k'k'k'k-k-k 

★★★★*******  the  adaptive  model  ************ 


JTOTl=Jl+Dlll 
JTOT2=J2+D222 
IF  (ER1.LT.0.0)  THEN 

X1D0T=-A1*K1*SQRT ( ABS (ER1) ) 

ELSE 

XlDOT=Al *K1 *SQRT ( ER1 ) 

END  IF 

IF  (ER2.LT. 0.0)  THEN 

X2DOT=-A2*K2*SQRT (ABS (ER2 ) ) 

ELSE 

X2DOT=A2  *K2  *SQRT (ER2 ) 

END  IF 

*********************************************************** 

*************  FIRST  LINK  ************* 

*********************************************************** 
SORT 

X1D=X1D0T-K*P1D 
V1  =  LIMIT ( -VSAT1 , VSAT1 , K3  *X1D) 

NOSORT 

IF  (FLAG1.EQ.1)  GO  TO  10 

IF  (VI. LT.VSAT1. AND. TIME. GT. 0.0005)  FLAG1=1 
NCHK1=N 1 
10  CONTINUE 

SORT 


P1DD=KM1*V1 


P1D=INTGRL (0.0, P1DD) 

P1=INTGRL ( 0 . 0 , P1D) 

VP1=V1- (KV1*TH1D) 

IM1=REALPL (0.0, L/R , VP1/R) 

TM1=KT1*IM1 

TNET1=TM1-TH1D*BM1-TL1 
TH1DD= ( 1 . /JTOT1) *TNET1 
TH1D=INTGRL (0.0, TH1DD) 

TH1=INTGRL (0.0, TH1D) 

*********************************************************** 

*************  SECOND  LINK  ************* 

*********************************************************** 

X2D=X2DOT-K*P2D 

V2=LIMIT ( -VSAT2 , VSAT2 , K3*X2D) 

NOSORT 

IF  (FLAG2.EQ.1)  GO  TO  20 

IF  (V2 .LT.VSAT2 .AND. TIME. GT. 0. 0005)  FLAG2=1 
NCHK2=N2 
20  CONTINUE 

SORT 

P2DD=KM2*V2 
P2  D=INTGRL ( 0 . 0 , P2DD) 

P2  =  INTGRL ( 0 . 0 , P2  D) 

VP2=V2- (KV2*TH2D) 

IM2=REALPL (0.0, L/R, VP2/R) 

TM2=KT2*IM2 

TNET2 =TM2 -TH2  D*  BM2 -TL2 
TH2DD= ( 1 . / JTOT2 ) *TNET2 
TH2D=INTGRL(0 . 0 ,TH2DD) 

TH2=INTGRL (0.0, TH2D) 

*********************************************************** 

********  ASSUMED  MODES  AND  FLEXIBILITY  ******** 

*********************************************************** 

Q1D=INTGRL (0.0, Q1DD) 

Q2D=INTGRL(0. 0,Q2DD) 

Q1=INTGRL (0.0, Q1D) 

Q2=INTGRL( 0 . 0 , Q2D) 

FLX  =-UE/L2 

*********************************************************** 


***********  SAMPLING  THE  SYSTEM  *********** 

*********************************************************** 

SAMPLE 


NOSORT 


IF  (N.EQ.O)  GO  TO  30 

P2=TH2 

P1=TH1 

IF  (N.GE.2)  THEN 

TH2 1D= (TH2 -TH2  2 ) / (2 . *DT) 
TH1 1D= (TH1-TH12 ) / ( 2 . *DT) 
ELSE 

TH2 1D=P2D 
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TH11D=P1D 
END  IF 

IF  (FLAG2.EQ.0)  THEN 

P2D= ( 2 . * ( (TH2-TH21) /DT) ) -TH21D 
IF  (N.GE.2)  THEN 

KM2=DABS (2 . *TH2/ (V2* ( (N2*DT) **2) ) ) 
END  IF 
END  IF 

IF  (N2.NE.NCHK2)  THEN 

P2  D= ( 2 . * ( ( TH2 -TH2 1 ) / DT ) )-TH2ID 
END  IF 

IF  (FLAG1.EQ.0)  THEN 

P1D=(2  .  *  (  (TH1-TH11) /DT)  )  -THUD 
KM1=DABS (2 . *TH1/ (VI* ( (N1*DT) **2) ) ) 
END  IF 

IF  (N1.NE.NCHK1)  THEN 

P1D=  ( 2  .  *  (  (TH1-TH11) /DT)  )  -THUD 
END  IF 

30  N=N+1 

N2=N2+1 
N1=N1+1 
TH22=TH2 1 
TH12=TH11 
TH2 1=TH2 
TH11=TH1 


TERMINAL 
METHOD  RKSFX 
* 


CONTRL  FINTIM=2 . 4 ,  DELT=0 . 00005 ,  DELS=0. 00025 
SAVE  (SI)  0.005, XI DOT ,  P1D , TH1D, X2DOT , P2D, TH2D, TH1 , TH2 , ZL 
SAVE  (S3)  0.005, PI, P2 , TH1 , TH2 , RR1 , RRD2 

SAVE  (35)  0.005, FLX , ZL 


GRAPH  ( Ll/Sl , DE=TEK618 ) 

TH1 ( LE=8 , UN= ' RAD ' , LO=- . 3 , SC= . 1 , NI=16) , . . . 

P1D ( LE=4 , NI=8 , LO=-4 . ,SC=2. , UN= ' RAD/SEC ' , SC=2 . ,PO=8) , 
X1DOT (LE=4 , NI=8 , LO=-4 . ,SC=2. , UN= ' RAD/SEC ' ,AX=OMIT) , . 
TH1D ( LE=4 , NI=8 , LO=-4 . , UN= ' RAD/SEC ' , SC=2 .),... 

ZL ( LE=4 , NI=8 , LO=-4 . ,SC=2. ,AX=OMIT) 


GRAPH  ( L2/S1 , DE=TEK618 , OV , P0=0 , 5 ) 

TH2 ( LE=8 , UN= ' RAD ' , LO=- . 6 , SC= . 2 , NI=12 )  _ 

P2D ( LE=4 , NI=8 , L0=-10 . , UN= ' RAD/SEC ' ,SC=5. ,PO=8) , . . . 
X2DOT ( LE=4 , NI=8 , LO=-10 . , UN= ' RAD/SEC ' ,SC=5. ,AX=OMIT) , 
TH2D ( LE=4 , NI=8 , LO=-10 . , UN= ' RAD/SEC ' , SC=5 . ) , . . . 

ZL ( LE=4 , NI=8 , L0=-10 . ,SC=5. ,AX=OMIT) 

* 

GRAPH  ( L3/S3 , DE=TEK618 )  TIME ( LE=8 , NI=8 , SC= . 3 , UN= ' SEC ' ) , . 

PI ( LE=4 , NI=4 , LO=- . 5 , UN= ' RAD ' , SC= . 5  PO=8 ) , . . . 
TH1 ( LE=4 , NI=4 , LO=- . 5 , SC= . 5 , UN= ' RAD '),... 

RRI ( LE=4 , NI=4 , LO=- . 5 , SC= . 5 , AX=OMIT) 
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■  > 


GRAPH  ( L4/S3 , DE=TEK618 , OV, P0=0 , 5 ) 

TIME ( LE=8 , NI=8 , SC= . 3 , UN= ' SEC 

P2 ( LE=4 , NI=6 , LO=- . 5 , UN= 1  RAD ' , SC= . 5 , PO=8 )  ,  .  .  . 

TH2 ( LE=4 , NI=6 , LO=- . 5 , UN= ' RAD ' , SC= . 5 ) , . . . 

RRD2 ( LE=4 , NI=6 , LO=- . 5 , SC= . 5 , AX=OMIT) 

* 

GRAPH  (L9/S5 , DE=TEK618)  TIME ( LE=8 , UN= ' SEC  1 , NI=8 , SC= . 3 )  ,  . . . 

FLX ( LE=6 , LO=-2 . , NI=8 , SC= . 5 ) , . . . 
ZL(LE=6, LO=-2 . , NI=8 , SC= . 5 , AX=OMIT) 

* 

LABEL  (LI)  PHASE  PLANE  (RIGID-FLEXIBLE  PLANAR  ROBOT  ARM) 
LABEL  ( L3 )  STEP  RESPONSE  (RIGID-FLEXIBLE  PLANAR  ROBOT  ARM) 

LABEL  ( L9 )  FLEXIBLE  MOTION  OF  THE  END-POINT 

* 

END 

STOP 
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